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ABSTRACT 


The calibration problem of a Short Baseline Underwater 
Vehicle Tracking Range is concerned largely with the coherency 
of path as the target vehicle passes from the domain of one 
array into that of another. The arrayS are placed 
approximately in a hexagonal mesh. Thus there are regular 
locations (triple overlap regions) where the vehicle is 
tracked simultaneously by three separate arrays. Longbase 
methods can be used to locate the vehicle in these isolated 
regions. Presumably the four determinations (three for the 
individual short baseline arrays and one for the long 
baseline) can be used to locate the arrays and help calibrate 
the range. 

This thesis contains a feasibility study for this idea. 
Vehicles are placed at known locations in the triple overlap 
regions. А sequence of correction actions is postulated and 
the algorithms have been programmed. It appears to work quite 


well within the confines of this idealized study. 
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THESIS DISCLAIMER 


The reader is cautioned that the computer programs developed 
in this research may not have been exercised for all cases of 
interest. While every effort has been made, within the time 
available, to ensure that the programs are free of computational 
and logic errors, they cannot be considered validated. Any 
application of these programs without additional verification is at 


the risk of the user. 
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I. INTRODUCTION 

The Naval Undersea Weapons Engineering Station (NUWES) 
currently operates nine test ranges for the purpose of testing 
and analyzing the performance of torpedoes. These ranges 
provide a three-dimensional track of torpedoes (or other water 
borne vehicles) from acoustic information received by bottom 
based sensor arrays. This thesis supports ongoing research 
conducted by Professor Robert R. Read of the U. S. Naval 
Postgraduate School, whose goal is to monitor the calibration 
of these ranges. 

The focus of this thesis is to support range calibration, 
specifically, by investigating sensor location error (position 
and orientation) using raw tracking data provided by the range 
itself. Since the sensors are inaccessible on the ocean 
floor, their exact locations are in doubt and estimated by a 
range survey procedure. The survey is costly and takes an 
entire day for a single sensor array, requiring that the range 
be shutdown, thus losing valuable testing time. This 
OPERATIONAL estimate of sensor location is subject to error 
and may differ from its ACTUAL location. Successive resurveys 
of sensor arrays find the array locations moved by as much as 
tens of feet. 

A difficulty in using the range, is that two or more 


versions of a torpedo track can be provided by adjacent 


sensing arrays. These differing versions of track manifest 
themselves as the torpedo traverses areas of mutual sensor 
monitoring (overlap regions). Accurate study of torpedo 
performance becomes difficult when considering the joint 
behavior of several vehicles (e.g. a submarine and torpedo). 

The calibration support methodology developed in this 
paper will focus on treating the location of those sensing 
arrays that are interior to the others (see Figure 3). The 
results will be a set of decision rules for the iterative 
correction of the interior sensors location. Appendix I 
contains a mathematical formulation of the problem and 
explains the choice of algorithm made. In the context 
presented here, this methodology works quite well. 

The organization of the thesis is as follows: 
Chapter II contains explicit background of the range setup and 
operation along with a description of locational errors. 
Chapter 111 contains the error correction methodology 
developed to solve for sensor locational errors. Specific 
assumptions are included here for this problem. Chapter IV 
integrates other sensors into the correction methodology and 
relaxes the initial assumption made in the solution 
formulation. Chapter V reports on the conclusions reached and 


recommendations for further work in this area. 


II. BACKGROUND 


A. RANGE CONSTRUCTION AND OPERATION 

References 1-6 outline previous work done in support of 
this project. This thesis, as with previous works, will 
utilize data from the Nanoose range. 

The Nanoose underwater tracking range consists of a number 
of sensing arrays of the short baseline (SBL) type positioned 
on the ocean bottom. Each array is three dimensional and 


contains four hydrophones (see Figure 1). 


SCHEMATIC DIAGRAM OF 5-0 
SENSOR ARRAY 


ACOUSTIC 
CENTER 





Figure 1. SBL Sensor Array. 


The acoustic center is the geometric center of the box formed 
by the arms of the sensor array and is used as the sensor 
array's location. The 30 foot sensor arms are short іп 
comparison to the target tracking distances, thus the name 
"short baseline" (SBL). 

Targets on the range are tracked in the following manner. 
The targets (e.g. torpedoes) are fitted with acoustic 
transmitters (pingers) which emit sound pulses at precisely 
timed intervals. The pingers and sensor arrays, are 
synchronized with the shore based clock. When an array 
detects an acoustic pulse, the transit times of the sound 
wave, from the target to the sensor array, are computed. 

A unique relative target position location (posloc) is 
found using the transit times measured from the target pinger 
to the four sensor hydrophones. The individual sound pulses 
are coded for the purpose of distinguishability. Figure 2 
shows a sensor array interacting with various target vehicles. 

A technique known as ray tracing is used to determine 
location. A ray is the normal to the acoustic wave front. 
Based on Snell's Law [Ref.7], ray tracing reconstructs the ray 
path traveled by sound in water. The differential of pulse 
arrival times at the four hydrophones are used to construct 
the ray's azimuth and elevation angles at the array's 
location. These are used to initialize the ray tracing 
algorithm. The computation works its way back to the sound 


source and the algorithm is stopped when the transit time is 
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Figure 2. SBL Sensor and Ray Paths 


'used up'. The result is a posloc for the target at the time 
of the ping. 

Reconstruction of the target local track is accomplished 
by joining the SBL poslocs of each array over time. This 
produces a relative or apparent target track from each sensor. 
Connecting these relative tracks gives a target track 
throughout the range. The use of many sensor arrays (Figure 
3), enables continuous monitoring of the entire range. Each 
array monitors a finite volume of water, limited by both 
acoustical attenuation and time gating. Careful arrangement 
of the sensor arrays enables full coverage without excessively 
sized overlap regions. These overlap regions are necessary to 
ensure track continuity throughout the range. 

There are two types of overlap regions, double and triple. 
The names correspond to the numbers of arrays which serve 
each, two or three respectively. An example of a torpedo 
traversing a double overlap region is presented in Figure 4. 
This shows an ideally continuous, or coherently connected, 
track as the torpedo crosses from one sensor region to 


another. 


B.  POSLOC ERRORS 

The track versions generated by the individual sensors are 
rarely connected as the target crosses these overlap regions. 
Separations in track are commonly on the order of 40-50 feet 


(slant range). 
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Figure 3. Nanoose Range. 
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Figure 4. Torpedo Track Through a Double Overlap Region 
(no sensor displacement errors). 


The causes of these discontinuities can be grouped into 3 
general categories: 

1) Water Condition Errors/Ray tracing 
Reference 1 contains an analysis of this problem. 

2) Pinger Timing Errors (Offset and Synchronization) 
Reference 2 details work done in this area. 

3) Sensor Location Errors (Position and Orientation) 
References 3-6 contain previous work done in this 
area. This thesis continues this work. 

Examination of the current ray tracing initialization 
method, shows that it can contribute up to 1/3 of the total 


target positional errors. A recommended method of 


initialization presented in Appendix Е, reference 1, 
Significantly reduces the errors caused by the current ray 
trace initialization method. 

The remaining significant errors are believed to be 
attributed to water column and sensor locational errors. In 
the water column, two effects come into play. First, the 
horizontal non homogeneity of the water causes the ray paths 
to become kinked. The second effect is the limited depth to 
which the depth velocity profile (DVP) 1S measured. The range 
obtains but one DVP measurement per day (due to cost and 
equipment constraints) and to a depth generally shallower than 
the deeper sensor hydrophones. Extrapolation of the DVP is 
required if a sensor hydrophone is deeper than the level 
provided by the measured profile. Uncorrected for, these 
effects can cause large posloc displacements. 

The location errors of the sensors lend themselves to 
relatively simple analyses and are discussed below. 

A number of other systematic error sources are present 
(e.g. bottom currents, curvature of the earth), but their 
effects are of much smaller magnitude. For the present they 


are ignored. 


е. LOCATIONAL ERRORS 
A sensor location comprises six components. These are 
the x, y, and z position of the sensors acoustic center (in 


the range coordinate system), and the xtilt, ytilt, and zrot 


angular orientation of each array axis from the range 
coordinate axis. The tilt angles are measured to the sensor's 
arms from the horizontal. The zrot component measures the CCW 
rotation of the sensor from east (zrot=0 implies the x-arm is 
pointed east). The xtilt, ytilt and zrot can be thought of in 
terms of roll, pitch and yaw , respectively. The x, y, г, апа 
zrot terms are measured during the sensor survey. Such a 
survey locates the acoustical center of the array with respect 
to the range coordinate system. When this is combined with 
the tilt angles obtained from the sensor's x and y arms the 
array's OPERATIONAL location is determined. 

The following terms are defined: 


- OPERATIONAL location - the position and orientation of 
the sensor array as determined by survey techniques. 


- ACTUAL location - the true position and orientation of 
the sensor array. 


Surveyed positions will suffer from the category 1 errors, 
water column nonhomogeneity and ray tracing. Another possible 
cause for the deviations from previous OPERATIONAL locations 
(survey to survey) can be due to physical array shifts on the 
ocean floor. If such shifts actually do occur, previous 
locational data is invalidated. Thus range monitoring must be 
performed continuously. 

The last two components of the sensors location, xtilt and 
ytilt, can differ from the ACTUAL tilts due to inaccuracies of 


the indicators in the arms of the sensors. 
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It is easy to visualize in the two dimensional case the 
effect on the posloc from errors in the six components of the 
sensor location. A situation similar to that depicted in 
Figure 5 occurs if we confine the location errors to just x, 
y and rotational offsets. This is attributed to a shift in 
the local coordinate system of the sensor from which the 
poslocs are found.  Posloc errors are less direct for errors 
in the z direction. Not only is there a change in the depth 
of the local coordinate system, but also in the water 
environment. As the sensor is 'displaced' in depth, the sound 


velocity at the new level of the hydrophones will be 


SENSOR ARRAY CROSSOVER REGION WITH SHIFTED SENSORS 


TRUE TORPEDO TRACK 
TORPEDO TRACK AS SEEN FROM A's RELATIVE POSITION 
TORPEDO TRACK AS SEEN FROM B's RELATIVE POSITION 


TRUE POSITION OF SENSORS A and B 
ASSUMED or RELATIVE POSITION of SENSORS 





Figure 5. True and observed Torpedo Track as seen by 
displaced sensors. 
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different. This changes the ray paths of the sound pulses and 
causes a disproportional change in the target posloc direction 
vector. 

For an example of the size of the errors produced from 
deviations in the six locational components, consider a 0.5? 
tilt error (xtilt or ytilt). This will cause a SBL posloc 
displacement of 40 feet at a 4000 foot range. This is a 


typical value of interest in an overlap region. 
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III. METHODOLOGY 
The adjustments to the OPERATIONAL location of SBL sensing 
arrays, will be first to the interior arrays. Interior arrays 
are those sensor arrays which have triple overlap with six 


adjacent, or satellite, sensor arrays (see Figure 3). 


A. ERROR ANALYSIS 

Figure 6 contains a schematic diagram depicting the triple 
overlap regions which provide information to the interior 
array. A triple overlap region (henceforth referred to as a 
region), represents a volume of water monitored, or served, by 
three independent sensor arrays; in the present case the 
specified interior array and two satellite arrays. Three 
independent poslocs will be generated for a given acoustic 
рата". In actuality these three poslocs will rarely be 
coincident. Their determination will be influenced by the 
error sources mentioned previously. 

1. Consensus Location (LONGBASE) 

The SBL poslocs are evaluated upon comparison with a 
consensus location. The choices for this location are one, or 
both of the other satellite poslocs, or some aggregate 
location of the three individual poslocs. Professor Read 
developed an algorithm which, assuming that the sensor arrays 


that service a region are positionally correct (x, y, and z), 
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Figure 6. Interior Array and its Triple Overlap Regions. 
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adjusts the azimuth and elevation angles (associated with each 
of the three arrays) so that the three poslocs coincide [Ref. 
3]. This method, long baseline (LBL), uses the transit time 
information from the C- hydrophones of the three sensor arrays 
in a region. In this way a 'new coordinate! system from these 
hydrophones is formed. Since the 'arms' of this newly formed 
surrogate array are long in comparison to the distance to the 
target, this is termed "long baseline". 

Initially the transit times from each array are converted 
into the three SBL poslocs, which are not coincident. Each 
posloc falls on the surface of a 'sphere' described by varying 
the azimuth and elevation angles for a fixed transit time. 
Each of the three arrays produces this 'spherical' surface and 
they intersect at a single point. This point may be located 
either upward or downward in depth, and perhaps at a different 
angular location than the SBL poslocs. 

Since no sensor positional errors are assumed in longbase, 
a problem develops in that the depth of the LBL posloc may be 
'forced' from the averaged depth of the SBL poslocs. This may 
or may not move it closer to the true depth. Аз the longbase 
algorithm determines the depth of this consensus point, the 
horizontal position is also. updated to maintain constant 
transit times. This program is the main tool exploited in our 
developments. The exploitation of this program will be 


described subsequently. 
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2. Consistency Of Errors 

A formulation of the problem and reasons for the choice of 
a coordinate descent algorithm are found in Appendix I. Once 
a consensus location for the target is found (LBL posloc), an 
error table can be made for the specified interior array. 
This table will consist of the differences between the LBL and 
SBL poslocs and contains the following locational attributes: 
elevation angle, azimuth angle, horizontal range, x, y, and z 
coordinates. Note that redundant information is supplied. 
The azimuth, elevation angles and horizontal range, can be 
converted to x, y and z coordinates. 

To describe the exploitation of the LBL algorithm, 
consider an interior array which contains six regions. 
Suppose that the OPERATIONAL and ACTUAL location of the six 
satellite arrays are the same, but not so for the interior 
array. Then the poslocs produced by longbase will provide 
information about the location of the interior array. (It has 
been verified that for three coincident poslocs, the LBL 
posloc generated will fall on that coincident point.) 

Figure 7 illustrates an interior array and two of its 
regions along with the LBL and SBL poslocs in two dimensions. 
Expanded views of the two regions are shown in the wings. One 
can perceive a correction to the right and upwards. Next 
consider six satellite regions. One can imagine a consistency 
in the offset and rotational nature of the x and y errors. 


Heuristically, the optimal location for the interior array can 
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be found by correcting one 'error! at a tiner 


B. ASSUMPTIONS 

The following assumptions are made in order to develop a 
prioritized set of corrections for the selected interior 
sensing array. 

1) SATELLITE SENSORS ARE ERROR FREE 

This assumption will allow full concentration on the 
posloc errors produced by the center array, without 
interference from noise in the locations of the satellite 
arrays. 

2) HOMOGENEOUS ISOSPEED WATER COLUMN (DVP) 

The advantage to making this assumption is that of 
Simplification and the elimination of the errors produced in 
generating the SBL poslocs using the current algorithms. This 
Simplifies the development of the error correction priorities. 
Posloc positional errors are now isolated to sensor array 


locational errors. 


C. TERMINOLOGY 
The following terminology is used throughout the paper and 
in the FORTRAN programs. 
For sensor number Kk, and overlap region ) (3-1 to 6): 
{ X, ;} position of the acoustic center of sensor 


array k, for 1=1-3 (x, y, and z) in the Ramee 
coordinates (depth positive downward) 
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2201) 


{ ERROR, |} 


{ SHIFT, |) 


РЕЛЕ 


иог 


1515.) 


(РН5, ) 


{PHL j} 


(THS,;) 


(THE; 


(Н5,)) 


(нъ) 


angular orientation of sensor array k for i- 
И tilt ytilt and гор) хеліс апа ус1і1е 
measured from the horizontal, zrot measured 
CCW from the Range centerline 


induced (known) locational error to sensor 
array k, for i=1-6 (x, y, 2, xtilt, ytilt, and 
zrot) 


corrections made to sensor array k's location 
for i=1-6 (x, y, Zz, xtilt, ytilt, and zrot) 


acoustic ping transit time from the target to 
sensor k's hydrophones i-1-4 (x, y, Z, and c) 
in region j 


SBL posloc position for sensor k in region j 
for 1=1-3 (x, y, and z) in the Range 
coordinates 


LBL posloc position for sensor k in region 7 
for 1=1-3 (x, y, and z) іп the Range 
coordinates 


azimuth angle (CCW from east) to sensor k's 
SBL posloc in region j from the c hydrophone 


azimuth angle (CCW from east) to sensor k's 
LBL posloc in region j from the c hydrophone 


elevation angle, from horizontal, to 
sensor k's SBL posloc in region j from the c 
hydrophone 


elevation angle, from horizontal, to sensor 
k's LBL posloc in region j from the c 
hydrophone 


horizontal range from sensor k's c hydrophone 
to region j's SBL posloc 


horizontal range from sensor k's c hydrophone 
to region j's LBL posloc 


Utilizing the above definitions, we have for sensor array k: 
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ACTUAL LOCATION: (Х,, Х,, Х,, А, А, Ақ) 


OPERATIONAL LOCATION: ((X,,;*ERROR,;) (X,;*ERROR,;) (X, 4 ERROR, з) 
(АЕККОК 4) (A,;*ERROR,;) (A, ,* ERROR, ,) ) 


Solving for (SHIFT,,), the ACTUAL location of the senSor amma 


will be obtained as such: 


х= (X TERROR DA НІНІ 
X.. = (X,,+ERROR,,) + SHIFT,, 
Хз = (X,3;+ERROR,;) + SHIFT,; 
А. = (A,,+ERROR,,) + SHIFT,, 
Ар, = (А ЕККОК 5) ЕНГЕН 
Аз = (А +ЕККОК 4) + ЗНТЕТ 


D. SETUP OF TEST CONDITIONS (SIMSTRT, SETUP) 

First values of the (ERROR, vector defined above are 
prescribed for each sensor array k, in order to generate the 
OPERATIONAL locations. Next the DVP to be used is selected. 
This DVP will be 4880 ft/sec and extend to a depth exceeding 
the deepest hydrophone in order to eliminate the need for DVP 
extrapolation. The starting points for our 'pseudo target' 
are arbitrarily chosen to be in the center of each triple 
overlap region j, at a depth of 400 ft. The transit times 
(ТІМЕ, |), 121-4, of acoustic pings are then generated ты 
these starting points to the ACTUAL array locations. The are 
times derived using the RAYFIT program (Ref. 1], are analogous 
to the times provided by the range. 

With the transit times and the OPERATIONAL location of the 
sensor arrays, SBL poslocs are generated through ray tracing. 
These SBL poslocs are the sensors perceived target position. 


The three poslocs in each region are then used to generate the 
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LBL poslocs. An error table for each sensor array is then 
formed using the LBL and SBL poslocs. This table contains the 
following LBL-SBL posloc difference information for sensor k 


and region j: 


шыек НЕГ” elevation angle differences 


PHER, ; = PHL; - PHS,;, azimuth angle differences 
НЕБО НЕ ВАН Поза олса ит апдеваітї ғегепсез 
XER,; = ХЫ; - Х5,,1, X Coordinate differences 

PER Ри -н зе вину сеобскалпасеталггекепсе5 

ZER,; З Хі, з 7 X8,;,, Z coordinate (depth) differences. 


E. ERROR FIXING (ERRFIX) 
1. Measure of Error 
The goal is to minimize separation between the LBL 
poslocs and the interior arrays SBL poslocs in each region. 
A measure of error to gauge success is the three dimensional 


distance between the two poslocs: 


а = JXER? YER? -ZER?. 


Instead of this we will use an approximate equivalent measure 


developed by Professor Read in reference 1: 


d » VZER?-HER?* (HLXPHER)? . 


This measure of error contains the horizontal separation 


distance (НЕК? = XER? + YER), and an additional term to 


21 


account for azimuthal errors. It's use circumvents the need 
Гог transforming spherical coordinates to cartesian 
coordinates. 

The total measure of error for a sensor array, will be the 
above measure averaged over the sensor's regions. 

2. Individual Error Corrections 

Error corrections can be thought of in four distinct 
phases: Azimuth, Depth (Z) by Elevation Angle, Tilt Angles 
(xtilt and ytilt), and coordinates (X; Y апа” This 
section examines individual locational error corrections. 
These individual error components are treated in isolation of 
the other locational errors that may exist for the sensor 
array. The next section will look at how to combine these 
error correction components into a integrated correction 
scheme to solve for array location. 

The component error corrections will be based on the 
average value of the individual errors of interest. The use 
of averaged error allows the optimal sensor location to be 
approached without excessive correction overshoot. 

Although an isospeed DVP is used, the algorithms will 
be written generally so as to facilitate the transition into 
a gradient environment. A correction scheme for each error 
independent of the others will be looked at first. A method 
to combine these into a correction algorithm will then be 


introduced. 
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а. Azimuth Errors 

An azimuth error (rotational error), of the 
interior array will manifest itself in each region regardless 
of the water environment. Due to the ranges to the triple 
overlap regions, small azimuth errors will cause large posloc 
separations. Since these errors are easy to spot and their 
correction greatly minimizes posloc separation, an attempt 
will be made to correct these first. 

The errors due to azimuth will be of similar 
magnitudes in each region, but most importantly, of the same 
(consistent) sign. The magnitude of these errors in each 
region can be masked by even moderate x and y coordinate 
displacements of the interior sensor. In correcting for this 
azimuth error the average azimuth error over the regions is 
used as an initial guess. This first guess will generally be 
smaller in magnitude than the true azimuth error. 

b. Depth by Elevation Angle 

Once again consistency in the signs of the 
elevation angles is sought. Elevation angles of the same sign 
can be caused by a depth error to the interior array. As 
above for the azimuth errors, a depth correction can be made 
if the elevation angles possess the same sign. The magnitude 
of the correction will again be based on the average of the 
depth errors. Correction of this angular error using depth, 


vice a function of the elevation angles was chosen for 
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simplicity.  Correcting for depth errors in this way also has 
the coincident benefit of correcting for elevation angle 
errors. 

In the isospeed environment, longbase is biased 
toward the error free (correct) satellite poslocs. A depth 
error to the interior array also correlates directly to a 
depth shift in its SBL posloc. This results because the SBL 
posloc direction vector is not effected by the depth change in 
the isospeed environment. Thus a positive, consistent, 
elevation error is induced by an OPERATIONAL depth that is 
deeper than ACTUAL. 

Transitioning to a gradient environment, longbase 
still remains biased toward the 'correct' poslocs. A depth 
error to the interior sensor now displays the following 
effect. As the sensor is moved deeper, the sound velocity of 
water will generally increase. This causes the elevation 
angles from each hydrophone to decrease when adjusted to the 
SBL posloc. This change in elevation angles, with respect to 
depth, will also be seen in the LBL poslocs for the same 
reason. Consistency will still be present even with this 
relationship between the elevation angles and depth. 

c. Tilt Angles 

The tilt errors, xtilt and ytilt, сап Бе 

visualized as the orientation of the plane containing the X, 


Y, and C hydrophones. This plane will be defined by xtilt and 
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ytilt angles from an origin centered at the C-hydrophone. Іп 
the presence of no other errors, the SBL poslocs will be at 
"truth" for the ACTUAL values of the tilts. It is in this 
manner that the correction will be made. By constructing two 
planes, one locating the SBL poslocs (erroneous) and the other 
locating the LBL poslocs ("truth"), the difference in plane 
tilts can be found. This difference is the correction to the 
OPERATIONAL xtilt and ytilt. For convenience, the regions 
closest to 0? and 90? (in the range coordinate system) are 
chosen, although any two non collinear combination regions 
will work. 
d. X, Y, and Z Coordinate Errors 

These three positional errors will be determined 
in an identical manner. Any of these coordinate errors will 
manifest itself in each region consistently, although not 
necessarily proportionally (see section 2b: Depth by Elevation 
Angle, for a summary of the unique depth effects). Errors 
from the comparison of LBL to SBL posloc positions, averaged 
over all regions will be used as a first guess correction to 
these coordinate errors. Since the effect of small angular 
errors produces large positional posloc errors, a fraction of 
this average error is used in order to guard against 


overshoot. 
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3. Integration of Error Corrections 

The above individual error corrections schemes are 
listed in the order of importance to the error fixing (ERRFIX) 
algorithm. The approach chosen will correct for angular 
errors first, followed by positional errors. This choice is 
made due to the large displacement effect caused by the 
angular errors at the distances of interest. 

The location corrections are preformed in an iterative 
fashion, correcting for one component error at a time. The 
new location of the array iS evaluated after each correction, 
before proceeding on to the next correction. This allows for 
a controlled approach to the ACTUAL array location. 

Figure 8 outlines the ERRFIX algorithm and figure 9 
the detailed flow diagrams for the specified components. The 
tilt correction component of the first six error corrects ш 
schemes, has a restriction placed on it. This restriction 
denies entry if no other previous corrections have been made. 
This minimizes the possibility of unnecessary cycling and 
invalid corrections to sensor location. The adjusted (SHIFT) 
tilt angles were found to move away from the ACTUAL tilt 
angles, in repeated back-to-back executions of the tilt 
correction component. 

The tuning constant 2 the positional corrections is 
introduced prior to the individual rectangular coordinate 
corrections. Since the angular errors have not been totally 


adjusted as yet, the posloc positional errors contain 
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Figure 8.  ERRFIX Logic Flow Chart. 
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Figure 9. ERRFIX Individual Component Logic Flow Chart. 
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influences both from the angular and positional sensor 
locational errors. The adjustment of the positional errors 
using but a fraction of the average error causes the optimal, 
or ACTUAL, location to be approached more slowly. This is 
desirable in early iterations. As the number of passes 
through ERRFIX increases, the tuning constant is increased to 
speed convergence of the algorithm. As the ACTUAL location is 
approached, and the posloc errors reduced in magnitude, a 
fairly constant correction rate is then maintained. To limit 
this weighting scheme, so as not to overshoot the ACTUAL 
location, a ceiling of 3 for the tuning constant is imposed 
after 15 passes. The selection of these number was based on 
a minimal sensitivity analysis so efficiency is not expected. 

Unrestricted position correction (x, y, and z) is 
allowed after all the consistent errors are removed. These 
correction schemes still use averaged posloc errors and the 
tuning constant in the computation of the SHIFT vector. 

Exit criteria for ERRFIX is based on the number of 
passes made and the number of nonprofitable attempts to 
correct the sensor's location. The algorithm is exited after 
either 60 passes through ERRFIX, or 5 non improving attempts 
to correct location are made. Additional reasons (other than 
to prevent infinite cycling), for these exit criteria are 


presented in chapter IV. 
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Е. LOCATION OPTIMIZATION (ANNEAL) 

Since ERRFIX is a heuristic, an optimal solution is not 
guaranteed. A simulated annealing (ANNEAL) algorithm is then 
employed to further minimize the objective function. The 
basis for this algorithm is outlined in reference 8. The 
random number generator that is required came from the IMSL 
Library of Mathematical and Statistical functions [Ref. 9). 
This library is developed for IBM PC computers and compiled in 
machine language and not reproducible here. Figure 10 
displays ANNEAL's logic structure. 

As ANNEAL is executed with the current solution (SHIFT) 
near the ACTUAL, a small step size to be applied to SHIFT is 
used. This small step size, while increasing run time, also 
helps to prevent overshoot of the optimal location. The 
numbers chosen to size the steps are based upon limited 
sensitivity analysis conducted on the objective function in 
the vicinity of the minimum. The validation check for the 
proposed step is to insure that the new angular values are 
within bounds (xtilt, ytilt; -7/2 to n/2, and zrot; "тг сс йн 

The 'cooling schedule' for the algorithm, which determines 
the probability of accepting a nonimproving step, is outlined 
in reference 8. A limited sensitivity analysis was performed 
to determine the parameters used in the calculation of the 


probabilities, and so efficiency may not be achieved. 
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Figure 10.  ANNEAL Logic Flow Chart. 
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Termination for the ANNEAL algorithm is two fold. Either 
30 bad (nonimproving) steps accepted, or the objective 


function within epsilon (10%) of zero, will cause exiting. 
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ТУ. RANGE INTEGRATION (CONTROL) 


Having the ability to correct for errors in an 'isolated' 
interior array (one with error free satellites), we turn to 
the problem of correcting several arrays. In order to 
accomplish this goal, the first assumption made, the interior 
array's satellites are error free, needs to be removed. То до 
this, an interior array will be chosen for correction, in 
which all of its satellite arrays are closer to their ACTUAL 
location than this interior one. The objective function 
presented on chapter III will be utilized to determine the 
array of interest. By choosing the array with the maximum 
objective function value (either range global, or with respect 
to its satellites), all of the satellite arrays are expected 


to require smaller locational adjustments. 


A. CONTROL 

The FORTRAN program, CONTROL, is set up to accomplish this 
range wide integration. Two problems arise when multiple 
arrays possess locational errors. First, in trying to achieve 
locational optimality for the array of interest, locational 
errors from the satellite arrays will prevent the objective 
function from reaching a zero value. Second, the sensing 


arrays that are selected for correction based on the objective 
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function value, may not be interior sensors (fewer than six 
triple overlap regions, e.g. array 24 of Figure 3). 

In the first problem, it was found that an iterative 
procedure was necessary to correct for multiple array location 
errors. Thus in ERRFIX, the restrictions on the number of 
passes and the number of 'bad' steps, was introduced (in 
addition to preventing infinite cycling). This allows for 
location improvement without over-improving towards possible 
erroneous LBL poslocs. After the array of interest exits from 
ERRFIX, the entire range is re-examined to find the new worst 
array, and the process repeated. Since correction is in a 
step wise fashion, entrance into ANNEAL is delayed until all 
arrays are 'close' to their ACTUAL locations. The logic flow 
chart for CONTROL is displayed Figure 11. 

The other downside to 'all' the range arrays possessing 
locational errors, is that there will be no anchoring point 
for range location. The array locations will be optimized 
with respect to each other, but not with respect to any fixed 
outside point. The target tracks will then coincide in the 
overlap regions, but may not be the true track; only a 
relative track. 

It was noted that arrays with induced locational errors 
produced objective function values significantly larger than 
the error free arrays. An attempt was made to take advantage 
of this trend. In singling out those arrays with the larger 


than average objective function values, the correction 
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Figure 11. CONTROL Logic Flow Chart. 
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methodology could be selectively controlled. This decision 
rule has the advantage of reducing computer run time by 
eliminating the 'error free' arrays from the iteration 
scheme. The values of the control parameters were chosen 
arbitrarily. 

The second problem addressed, involvement of arrays with 
fewer than six overlap regions, could not be studied fully due 
to time constraints. The problems that occur here can be seen 
by a study of array number 24. This array has its overlap 
regions all located on one side. This will cause the ERRFIX 
algorithm to induce invalid depth corrections caused by tilt 
errors. Any tilt errors that happen to displace all the SBL 
poslocs upward (negative elevation angle errors), will be seen 
as a depth error in the Depth by Elevation Angle component of 
ERRFIX. This effect will cause multiple optima to exist for 


these sensors without a full complement of regions. 
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V. RESULTS 


A. ERROR FREE SATELLITES/ ISOSPEED DVP 

In this ideal situation, sensor array 15 was chosen as the 
test case. А random location ERROR was then applied to the 
array location. The initial location chosen (ACTUAL), is the 
location currently defined by the Nanoose range. Application 
of the ERROR vector to this ACTUAL location generated our 


OPERATIONAL location. This data is presented below. 


Table I. SENSOR ARRAY 15 LOCATIONAL DATA. 


COMPONENT ACTUAL INDUCED RESULTANT 
LOCATION ERROR OPERATIONAL 
LOCATION 


MNT C) 53249.43 11000 53260.43 
y —— -6354.60 28.00 -6326.60 
2 | 1316.66 1314.66 


ptt 04003346 0.0250 02028245 
(radians) 

ptc 0.004509 0.0100 0.014509 
(radians) 


zrot | 0.581544 -0.0100 0.571544 
(radians) 
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Shown below (Figure 12), is a two dimensional depiction of 


sensor array 15 in both the ACTUAL and OPERATIONAL locations. 





Figure 12. ACTUAL and 
OPERATIONAL Location of Sensor 
Array 135: 


In evaluating this array, the triple overlap regions 
associated with it will be defined in according to the 


following numbering scheme (refer to Figure 3): 


SERVING ARRAYS REGION 
15,14,24 13 
15, 5,14 14 
15, 5, 6 15 
15, 6,16 да 
15,16,25 22 
15,24,25 23 
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With the above numbering system, sensor array 15 


(OPERATIONAL), and its six satellites produce the following 


posloc data by region: 


REGION 13 
= а а оо 
ARRAY 15 ARRAY 14 ARRAY 24  LONGBASE TRUTH 

Beposloc 49502.98 49493.30 49493.30 49506.25 49493.30 
Еос 78599035 -8593-79 —6593.79 -8586.09 -8593. 79 
Z posloc 485.07 400.00 400.00 436.63 400.00 

PHS -2.60112 -0.50009 1.58474 

PHL =2.60333 -0.49714 1:58175 

THS 0-129055 21122 0.20692 

THL 9720163 0720287 Oe 9853 

HS 4376.31 4383.21 2302225 

HL 4366.69 4390.90 4369.78 


REGION 


14 


X posloc 
Y posloc 
Z posloc 


PHS 
PHL 


THS 
THL 


HS 
HL 


ARRAY 15 


49371.89 
74363.58 
зена 


2 56950 
2.66441 


018555 
0.21244 


4361.03 
4337.52 


ARRAY 5 


49404.92 
-4356.84 
400.00 


21053591 
21.595648 


22212209 
0-21367 


4319756 
4318.19 


ARRAY 14 


49404.92 
=4 356.84 
400.00 


0.51668 
0.51724 


0.21411 
02215 1) 


4322525 
4320.87 


LONGBASE TRUTH 

49402.52  49402.92 

-4356.84 -4356.84 
2393.66 400.00 


C—O Ца” ш SS SSE кезь 
ЭЭ 


REGION 15 


ARRAY 15 

Х ровіосс 53178. 227 
Y posloc -2053.41 
Z posloc 421.31 
PHS 1.58878 
PHL 1.57 5:43 
THS 0.20833 
THL 0.22296 

HS 4294.82 

HL 4281.08 


ARRAY 5 


5323-2015 
- 2085 - 
400.00 


=0. 50279 
-0.49884 


09215565 
0.22542 


4248.10 
4238782 


ARRAY 6 


53235225 
20551055 
400.00 


=2. 63487 
=2 . 63884 


0.21393 
0.22368 


4249.12 
42 39091 


LONGBASE TRUTH 

53235707 05329 5 25 

22066.51 20855 
356.59 400.00 


ARRAY 15 

X posloc 51018.62 
Y posloc «4259.21 
2 posloc 308.48 
PHS 0.50664 
PHL 0.48823 
THS 0229287 
THE 02219275 

Н5 4303.74 

HL 4316.75 


REGION 21 

ARRAY 6 ARRAY 16 
57054.98 57054.98 
=4330. 68 =4330. 68 
400.00 400.00 
-1.54664 2465435 
-1.54360 2: 6552 
дае 021139 
021920 0521905 
4308.39 2329957 
4300.74 4321-91 
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LONGBASE TRUTH 

57067.90 57054.98 

-4322.70 -4330.68 
364.99 400.00 


REGION 22 


X posloc 
Y posloc 
2 posloc 


PHS 
PHL 


THS 
THL 


HS 
HL 





ARRAY 15 


57060.74 
z8516:21 
285.63 


79.51801 
E0915 73:29 


02223391 
0270/53187 


4379.83 
4407.10 


ARRAY 15 

ENDposloc 53322.58 
Y posloc -10673.91 
Z posloc 373.46 
РН5 з 12550529 
РНІ, -і 5619) 
Но 0.21740 
THL 0.20040 

HS 4326.89 

HL 4342.51 


ARRAY 16 
57054.15 
78587-96 

400.00 


== 613930 
-2.61448 


0.20669 
0.20498 


4429.02 
4430.60 


ARRAY 24 


532293 N 


20109007. 34 


400.00 


0.54138 
0.54471 


0.20689 
0719609 


4362.89 
4372.52 


ARRAY 25 


57054.15 
= 
400.00 


1.55241 
1 55502 


0.18370 
Фоно ее) 


4416.12 
4417.52 


КЕСТОМ 23 


ARRAY 25 


и! 


-10707.34 


400.00 


25931716 
2853006 


0.18696 
0.17609 


4337.38 
4346.04 
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LONGBASE TRUTH 

57081449 57054.15 

– 8552 52. -2587.95 
407.54 400.00 


LONGBASE 


TRUTH 


перо ваше 2оз. 11 
2106589589 2107097734 
447.16 400.00 


Summarizing the above data into the error table gives the 


following: 


TABLE II. ERROR TABLE FOR SENSOR ARRAY 15 (ERROR FREE 
SATELLITES/ISOSPEED DVP) 


edere 1и |в [а | oz | om 
THER 


= HER... “#9622 sea DO 7153/59 13.010 27.266 15.624 | 


KER 3.28 | зо? | 57.3% | 49.280 -28.753 


YER 155258 8.178 -13.091 -63.494 270, 306 7152913 


ев | лө | seso | 12190 | 23.58 





This test case shows the depth exaggeration produced by 
LONGBASE. The poslocs generated do not approximate those 
normally encountered on the range. This is not expected since 
only one array is mispositioned while its satellites are error 
free. 

Submitting this data to ERRFIX the following solution is 
returned after 13 passes. (The algorithm was terminated on 
the 5 bad steps criteria, so only 8 passes were needed to 


produce the solution.) 
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TABLE III. SENSOR ARRAY 15 ERROR CORRECTION DATA (ERRFIX). 
ERROR FREE SATELLITES - ISOSPEED DVP. 











INDUCED CORRECTED 
COMPONENT ERROR 





11.000 -11.000 
-2.000 -28.000 
Z (ft) -2.000 2.000 


xtilt 0.02500 -0.02500 
(radians) 

vert 0.01000 -0.01000 
(radians) 


zarot “020 000 
(radians) 






p—————— Á Aa o — а P дА 









0.01000 





The solution presented above for array 15 is accurate to 
the thousandth of a foot and less than a hundred thousandth of 
a radian. The above solution was achieved without utilizing 
the ANNEAL algorithm. 

Several other test cases for array 15 were run to verify 
the algorithm following the same format as above. The results 
of the induced ERROR and the corrected SHIFT are presented on 


the next page (Table IV). 
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В. INTERIOR ARRAY CORRECTION (SATELLITES WITH ERRORS/ 

ISOSPEED DVP) 

The ERRFIX and ANNEAL algorithms are now checked for 
performance on an interior array whose satellites contain 
locational errors. Array 15 is again chosen as the array of 
interest. The ERRORs induced on the arrays are such that 
array 15 will have the largest objective function with respect 
to its satellites. Table V on the next page, displays the 
ERRORs induced for all the arrays. These ERRORs were chosen 
со as to obtain initial posloc data similar to that normally 
seen on the range. Appendix H displays the regional posloc 
data. 

Submission of this data to ERRFIX produced the following 
corrections to array 15 (Table VI) after one pass. ERRFIX was 
exited after 11 passes, the last five non improving. With the 
exception of the ytilt component, the locational errors are 
reduced by 65 to 97$. The ytilt component was over corrected 
and increased its error magnitude by 1425. Table VI also 
shows the cumulative corrections produced by ANNEAL, using the 
ERRFIX corrections as input. The y and ytilt component errors 
are improved in ANNEAL while the other component errors are 
degraded. This supports the previous assessment of 
iteratively correcting the arrays iteratively through ERRFIX 


before attempting ANNEAL. 
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TABLE VI. ACCUMULATED CORRECTIONS FOR ARRAY 15. ERROR 
INDUCED SATELLITES - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
ERROR CORRECTION CORRECTION 


| 11.000 
| ҮЙ ЕС) 





















-11.756 -15.789 
28.000 -35.444 -29.434 | 
ШІС -2.000 2.706 4.577 


кеша 0.00400 -0.00444 0800727 
(radians) 
| усе 0.00500 240.001 209 =0. 007/14 
(radians) | — = || 


zrot анонс бн 0.00973 0.00942 
(radians) 





C. CORRECTION OF MULTIPLE INTERIOR ARRAYS (ISOSPEED DVP) 

After verifying the ERRFIX and ANNEAL algorithms work 
properly, correction for multiple interior arrays are now 
preformed. ERRORS are induced in the six interior arrays (see 
Figure 3) of the range, 4, 5, 6, 14, 15, and 16. Table VII 
displays the induced ERRORs. The exterior arrays are all 
properly located in this example. 

It was necessary to place a 'no repeat' restriction on the 
arrays for entry into ERRFIX. This restriction prevented the 
CONTROL algorithm from cycling on one single array. Iterative 


passes through ERRFIX was terminated when all the objective 
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functions were less than one. The choice of one was 
arbitrarily chosen to speed convergence (entry to ANNEAL). 

Due to the consistency of errors approach in ERRFIX, as the 
ACTUAL location is approached, the magnitude of the correction 
is decreased. Presented below (Tables VIII - XIII) are the 
corrections (SHIFTS) produced from ERRFIX at the termination 


criteria mentioned above. 


TABLE VIII. ACCUMULATED CORRECTIONS FOR ARRAY 4. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


__ЕККОК CORRECTION | —M 
X БТ -0.500 0.420 эю ресе 506 


xdg -0.00600 0.00594 0.00599 
(radians) 

ytitlt | 0.00300 202500288 20900298 
(radians) |! 


zrot ГӨМ 07102060 0.00206 0.00200 
(radians) 
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TABLE IX. ACCUMULATED CORRECTIONS FOR ARRAY 5. ERROR 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
ERROR € Sa 


Хаве) 7900 = И 7.728. 514 | Tzu 


У | -6.200 5.563 6.159 
7, || то) -. -1.800 2.846 1.939 


жү 0.00700 -0.00677 -0 2100702 
(radians) 


УЕТЕТЕ -0.00300 | 0.00294 0.00298 
(radians) 


21500 0.00100 -0.00099 -0. 0050/19 
(radians) 






















TABLE X. ACCUMULATED CORRECTIONS FOR ARRAY 6. ERROR 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
ERROR — CORRECTION 


=5. 000 f | 5.373. з 4.975 


7.000 -72 936 - 8009 
4.000 -2.754 3.808 


0.00500 20.00499 -0.00498 
0.00200 -0.00243 -0.00200 
ОСОО 9.0023 0.00300 

























Sta NE 
(radians) 


меле Не 
(radians) 


- = 






БЕО 
(radians 
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TABLE XI. ACCUMULATED CORRECTIONS FOR ARRAY 14. ERROR 
INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
ERROR CORRECTION CORRECTION 

















(ft) 4.000 | -3.941 -4.027 | 
Y (ft) 28.000 8.009 7.994 
Z (ft) 5.000 SAMO 4.994 


ЕЕ -0.00900 0.00915 0.00901 
(radians) 

УЕТЕТЕ -0.00400 0.00392 0.00401 
(radians) 


гос Ваала UO =O 2S 
(radians) 


и | эээ. 


“02005008 





ТАВЬЕ ХТТ. ACCUMULATED CORRECTIONS FOR ARRAY 15. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
E ERROR CORRECTION | CORRECTION 
Ци 11.000 -10.650 -11.029 | 


Y (ft) 28.000 Е Eco 
Z (ft) 2 050 1.149 2.064 


ИЕС 0.02500 -0.02451 -0.02499 
(radians) 

ПЕТЕ ДЕ 0.01000 -0.01020 -0.01002 
(radians) 


ZEOT а.а G 0.01004 0.01000 
(radians) 


















ЗІ 


TABLE ХІІІ. ACCUMULATED CORRECTIONS FOR ARRAY 16. 
ERROR INDUCED INTERIOR ARRAYS - ISOSPEED DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
у ЕККОК CORRECTION CORRECTION 


rome Us -5.004 
Y Vita € -2 7000 
4.000 




























T7 03m 2.001 
зо за зЗ „94 







2 ta = 

ЕТ ВЕ 0.00400 50. ООЗЗ6 -0.00400 
(radians) 

масак ә 0.00200 —0_ 00192 =0. 00200 
(radians) | 










—M— M х. 


-- | 
| 0.00100 | 






zrot 
(radians) 


-0.00102 






-0.. 00 0/0 





ERRFIX corrected well for all locational components except 
depth. The corrections provided by ERRFIX left errors of at 
most 58$ remaining (depth correction for array 5). The only 
other locational component approaching this magnitude is the 
y component for array 16 (48$ error remaining). Internal 
passes through ERRFIX provided for improvements in all cases 
before termination (on 5 non improving passes). 

Once all the interior array objective functions fell below 
one, control was passed to ANNEAL. The restriction of no 
'back to back' corrections for an array was also in place 


here. Convergence within ANNEAL was generally quick, with 
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termination occurring on 30 consecutive nonimproving steps 
accepted in the search. In order to maximize the potential 
for optimization, an internal control structure was added to 
ANNEAL to increase the step size and then decrease the bad 
step acceptance probability. As soon as a lower objective 
function value is found (over the previous minimum), the 
parameters are returned to their initial values. ANNEAL 
termination occurs after 1500 passes with the larger step size 
and lower probability, if a lower objective function value has 
not been found. This exit condition was only invoked three 
times in the above test case. The results of ANNEAL 
performance (cumulative corrections) are displayed along with 
mae ERRFIX corrections in Tables VIII to XIII. 

CONTROL was terminated when any array's objective function 
value increased after a return from ANNEAL. This occurred 
with array 15, after a total of 33 array entrances into ANNEAL 


(this was array 15's seventh entry to ANNEAL). 
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VI. CONCLUSIONS AND RECOMMENDATIONS 


А. RESULTS 

The goal of this thesis was to investigate interior sensor 
array locational errors, and develop a set of decision rules 
to correct any errors that may exist. The primary tools used 
here include, long baseline methodology and a consistency of 
errors approach. 

It was found that although LONGBASE was written under the 
caveat of no positional array errors existing, it could still 
be used to aid in correction of an array's location. Іп fact 
it worked better than using an averaged consensus posloc (of 
the three SBL poslocs) to compare the SBL poslocs against. 

The current research did not assume that the exterior 
arrays (those with fewer than six triple overlap regions) were 
locationally in error. Investigation of their inclusion into 
the error correction methodology was not conducted, so their 
effect on the algorithms is undetermined. The test cases vá 
in this study also used an isospeed DVP. Appendix A addresses 
the effects of a DVP containing a gradient. The resultant 
gradient induced errors resulting from the use of Professor 


Read's recommended ray tracing initialization method, are 
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shown to be small in magnitude. Time constraints prevented a 
study of their effect on the error correction scheme. 

The final algorithms, ERRFIX and ANNEAL, have demonstrated 
excellent robustness in the correction of locational errors. 
An annealing algorithm, by itself, may be able to successfully 
minimize array locational errors. Since the array's location 
is six dimensional, it was deemed unreasonable to rely solely 
on this technique in order to keep computer run time down. 
The error correction algorithms were written so as to be able 
to accept raw tracking data from the range. The data used in 
the study here was internally generated to eliminate any 
systematic error sources commonly found in an underwater 
tracking situation. Times provided by the range are generally 
suspect in themselves, thus preventing ‘error free' posloc 


determination. 


B. RECOMMENDATIONS FOR FURTHER RESEARCH 

In expanding this technique to the entire tracking range, 
three problems need to be analyzed. 

First, there is the treatment of exterior arrays. The use 
of these arrays in the current methodology may have 
insufficient consistency of errors to provide locating 
information. The use of double overlap regions [Refs. 4,5, 
and 6], may be necessary to supply enough data to accurately 


correct these exterior arrays. 
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Second, the optimization of the internal control 
parameters in the ERRFIX, ANNEAL and CONTROL algorithms is 
necessary before attempting entire range correction. This 
will also reduce computer run time allowing for more frequent 
calibration updates. The run times in solving for a single 
array with error free satellites was on the order of 5 
minutes. The case of solving for all the interior arrays 
required about one and half hours. 

The third area of work, is the effect of gradient water 
environments. Although the errors seen resulting from the 
gradients are 'small', the effect on an iterative correction 
scheme may be multiplictative thus inhibiting the correction 


of the true locational errors. 
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APPENDIX A: GRADIENT DVPsS AND RAY TRACING INITIALIZATION 

An isospeed DVP was used during the formulation of this 
correction method. This had the advantage of eliminating 
extraneous errors from the analysis. 

About third of posloc errors were estimated to be due to 
the ray tracing initialization in a gradient DVP environment. 
The study performed in reference 1, showed that the current 
ray tracing initialization method used by NUWES produced 
errors on the order of feet in depth and horizontal range, and 
third decimal place (radians) in elevation and azimuth angles. 
The method recommended by Professor Read reduced these errors 
by a factor of 10 for depth, horizontal range, and elevation 
angle, and a factor of 100 for azimuth angle. 

Figure 4 of reference 1, showed a sinusoidal nature to 
each of the above error components. The skewed nature of the 
curves produced made direct analysis difficult. Standardizing 
the array axis (setting xtilt = ytilt = zrot = 0) produced the 
following curves (Figure 13). This figure mimics Figure 4 of 
reference 1, array 1 with the DVP of 3/22/89 used for sound 
Sources at 3000, 4000 and 5000 feet. 

With a standardized local coordinate system the sinusoidal 
nature of the errors becomes visible. Analysis of the angular 
errors (azimuth and elevation angles) shows the errors to be 


90” out of phase. The zero error points for azimuthal error 
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occurs at 45° and 235° rotation (CCW from east, the x axis). 
This corresponds to the point where the sound source is 
equidistant from both the x and y hydrophones. The maximum 
azimuthal error occurs at 135° and 325°, 90° out from the zero 
errors. These points are where the sound source has maximum 
distance to one of the hydrophones (x or y), and minimum 
distance to the other. The elevation angles display the 
opposite phenomenon, maximum errors where the sound source is 
equidistant form the x and y hydrophones, and zero error at 
the maximum/minimum distance to one or the other. 

This effect on the errors is traced back to the geometric 
construction of the posloc point to initialize Professor 
Read's ray tracing method. A constant speed of sound in water 
is used to construct this posloc point. This speed of sound 
used (the speed at the level of the x, y, and c hydrophones) 
is larger than the speed found along the ray path. (Speed of 
sound in water generally decreases as you get shallower.) 
This larger speed of sound used causes the distance traveled 
back along the ray path to be longer than it is in reality. 
Thus the sinusoidal nature of the errors occur with respect to 
the array axis, or the sides of the pyramid constructed to 
locate the posloc. The discrepancies observed in figure 13 
are the result of time differences (time from constructed ray 
paths versus real transit times) in the ninth and tenth 


decimal place. 
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Before proceeding in an attempt to correct the effect, the 
posloc errors produced are examined. Using array 15, with 
ERROR free satellites and an isogradient DVP (+ 0.08 ft/sec), 


the following correction data is produced (Table XIV). 


TABLE XIV. CORRECTIONS FOR ARRAY 15 ERROR INDUCED 
SATELLITES - ISOGRADIENT DVP. 


COMPONENT INDUCED ERRFIX ANNEAL 
ERROR CORRECTION CORRECTION 


[11.000 асеў 
z (ft | 
(radians) 


1.994 1.994 
0.02500 =0 2025105 -0202505 

У ЕЛЕШЕ 0.01000 

(radians) i| 


аддзе» -0.01005 
РОК -0.01000 | 
(radians) 






































020000”! 0.01000 
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The following regional posloc data is provided to give the 
reader an idea as to the effect this gradient has on the 
poslocs. The magnitude of the posloc errors are proportional 


to the gradient of the DVP. 


REGIONAL POSLOC DATA BEFORE ERRFIX 


REGION 13 
ARRAY 15 SBL ARRAY 14 SBL ARRAY 24 SBL LONGBASE GOAL 
X 49502.76 49493.37 49493.35 49506.26 49493.30 
Y -8600.14 =o ao =2525. 55 -8586,09 55300079 
2 484.96 400.27 399272 35:27 400.00 
ТН5 015535 0720397 0.19983 
THE 0.19475 0219595 0.19164 
PHS 222560099 -0250009 1.58473 
PHL 22211610333 -0.49714 ТЕ 
HS 4376.91 4383.27 4362.19 
HL 4366.68 4390.91 4369.79 
REGION 14 
ARRAY 15 SBL ARRAY 5 SBL ARRAY 14 SBL LONGBASE GOAL 
X 49371731 49404.88 49404.99 49402.53 49404.92 
Y -4363.06 -4356 75 -4356. 83 - 4355 а -4356. 84 
2 509.94 3992977 400.26 393290 400.00 
THS 0: 17852 02258517 0.20696 
THL 0.20527 0220654 0.20844 
PHS 21559325 2119579592 051667 
PHL 2.66441 -1 259647 0.51724 
HS 4361.78 4 3 135105 1 4322.31 
HL 2337.51 4318.20 4320.87 
REGION 15 
ARRAY 15 SBL ARRAY 5 SBL ARRAY 6 SBL LONGBASE GOAL 
X 33179.04 53235.71 5 3235103 53239.67 > 
Y г 2053. з2 -2085 ба = 20858 75 «2006552 "2985269 
2 421.03 512212 76 400.19 25272211 400.00 
THS 0220135 0.20876 0.20691 
THL 0.21564 0.21817 0.21643 
PHS 12254560 0250279 -2.63486 
PHL 1.57543 -0.49884 -2.63884 
HS 4294.90 4248.04 4249.16 
HL 4281.07 4238.83 4230402 
REGION 21 
ARRAY 15 SBL ARRAY 6 581 : ARRAY 16 SBL LONGBASE GOAL 
X 51:018.23 57054.97 57054.96 57067.89 57054.98 
ү -4260.02 -4330.75 =4 330.62 -4322.71 -4330.68 
Z 308. 33 400.30 400.20 366.14 400.00 
THS 0.22589 0.20394 0.20415 
THL 0.21243 0.21190 0: 21205 
PHS 0250651 12516655 2.65434 
PHL 0.48823 -1.54360 2765132 
HS 4303.00 4308.46 4329.61 
HL 4316.74 4300.75 4321.92 
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ТН5 
THE 
PHS 
PHL 


HE 


THS 
TRE 
PHS 
PHL 


HL 


THS 
THL 
PHS 
PHL 


HL 


ARRAY 15 SBL 


57060006 
-8515:56 
285.62 
0.22678 
0.19899 
=O oy oS 
*09553290 
4378.94 
4407.09 


ARRAY 15 SBL 


53323. 36 
= 106765268 
373.44 
0.21032 
0.19366 
=1. 35511 
о? 
4326.67 
4342.48 


ARRAY 15 581, 


49493.30 
-853 72 
399799 
0.20342 
0.20342 
=2: 60761 
-2 60761 
4358.54 
4358755 


ARRAY 15 SBL 


49404.92 
-4356.84 
400.00 
0.20440 
0.20440 
2.65763 
265093 
4338.39 
4338.39 


REGION 


ARRAY 16 SBL 


57054.14 
- 858 848 У 
399790 
0.19945 
0:39 7787 
2205139 
-2.61448 
4429.00 
4430.60 


REGION 


ARRAY 24 SBL 


53293. I6 
=10707.40 
400.05 
0519572 
0: 189330 
0.54136 
0.54472 
4362.90 
437252 


КЕСІОМ 


ARRAY 14 SBL 


49493.37 

Ве: 

400.27 
0.20397 
0.20403 
205059009 
205500959 
4383.27 
4383.20 


REGION 
ARRAY 
49404.88 
-4356.78 
399.77 
0720517 
95220512 
-1 5222 
=! 
4319791 
4319.56 


5 SBL 


22 


23 


13 


14 
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ARRAY 25 SBL 


57054.14 

-8588.02 

5901369 
05196592 
0.17480 
255241 
1755302 
4416.06 
4417.53 


ARRAY 25 SBL 


5329910 


-10707.39 


3997 89 
0. 17987 
0716905 
22586377 
2788026 
4331. 36 
4346.07 


REGIONAL POSLOC DATA AFTER ERRFIX 


ARRAY 24 SBL 


49493.35 
- 859 31485 
399275 
0- T9983 
(22213915 
1.58473 
1.58474 
4362.19 
4362.25 


ARRAY 14 SBL 


49404.99 
-4356.83 
400.26 
0.20696 
0.20702 
0. 54667 
0.51568 
43222531 
4322-25 


LONGBASE 


57051.48 
"858506519! 
407.29 


LONGBASE 


53293258 


- 10689185 


445.45 


LONGBASE 


49493.30 
-8593 (08 
400.00 


LONGBASE 


49404.92 
-4356.84 
400.00 


GOAL 
57054.15 
-8587 6 

400.00 


GOAL 
532953 КИ) 


-10707.34 


400.00 


GOAL 
49493.30 
—859 3 

400.00 


СОАТ, 
49404.92 
-4356.84 

400.00 


THS 
THL 
PHS 
PHL 


HL 


THS 
THL 
PHS 
ЕНІ 
Н5 
HL 


ТН5 
THL 
PHS 
PHL 


HL 


ARRAY 15 SBL 


53235075 
-2085,69 
400.01 
0.20680 
0.20680 
1552237 
1152297 
4289.76 
4289.76 


ARRAY 15 SBL 


57054.98 
-4330.68 
400.00 
20511 
0.20511 
06492517 
0.49257 
4323.92 
4323.92 


ARRAY 15 SBL 


57054.15 
о 
400.00 
220118 
220118 
20552522 
2105526522 
4405.03 
4405.03 


ARRAY 15 SBL 


55229-11 
-10707.34 
339.99 
0.20470 
0.20470 
22255971 
= | 55771 
4332.16 
1332.16 


REGION 
ARRAY 
Eug 35.7 7 
-2085:64 
2927Ж 
0720876 
0.20870 
290550279 
20:50279 
4248.04 
4248.10 


REGION 
ARRAY 
57054.97 
-4330,75 
400.30 
0.20394 
0.20401 
21554065 
-1.54665 
4308.46 
4308.39 


REGION 


ARRAY 16 SBL 


57054.14 
-8587:89 
399: 90 
0.19945 
0.19942 
ит 
== 10130 
4429.00 
4429.02 


REGION 


ARRAY 24 SBL 


53295. 16 
=10 7/07740 
400.05 
02515972 
шава Э 
0.54136 
0.54138 
4362.90 
4362.89 


6 SBE 


15 
5 SBL 


21 


22 


23 
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ARRAY 
9525951 95 
22085375 

400.19 
0.20691 
0.20696 

-2.63486 
-2.63487 
4249.16 
4249.12 


ARRAY 16 SBL 


57054.96 

-4330.62 

400.20 
0.20415 
0.20420 
2.65434 
2.65435 
4329.61 
1329.57 


ARRAY 25 SBL 


57054.14 
Е 
399.69 
О ОБ 
0.17646 
1.55241 
1.55241 
4416.06 
4416.12 


ARRAY 25 SBL 


ESTO ИО 
2107207533 
39999 
217987 
0.17984 
250577 
2-58376 
4337.36 
4337 238 


6 SBL 


LONGBASE 


53255775 
22085.69 
400.00 


LONGBASE 


57054.98 
-4330.68 
400.00 


LONGBASE 


S 7054.15 
79587.96 
400.00 


LONGBASE 


5929311 
21070734 
400.00 


GOAL 
53235775 
72085.69 

400.00 


GOAL 
57054.98 
=4 330.68 

400.00 


GOAL 
57054715 
=858 96 

400.00 


GOAL 
33293. 11 
=10707.34 
400.00 


After ERRFIX, and array 15 has almost all of its 
locational errors corrected. The remaining errors are seen in 
every array and are the result of the gradient. The LBL 
poslocs generated in this environment are coincident with the 
true (goal) posloc. With error free arrays, the gradient does 
not prevent LONGBASE from accurately determining the targets 


position. 
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APPENDIX B: COMPUTER PROGRAMS SIMSTRT AND SETUP 


SUBROUTINE SIMSTRT(DVP,EXT,RTIME, RORIGIN) 


THIS SUBROUTINE GENERATES THE TRANSIT TIMES (RTIME) FROM A 
STARTING POINT ON THE RANGE (RORIGIN) WHICH IS GENERATED BY THE 


SUBROUTINE 
SIMULATION 


POINST. THIS SUBROUTINE IS TO INITIATE THE NANOOSE RANGE 
FOR ERROR CORRECTIONS. THE OUTPUTS CREATED BY THIS 


PROGRAM SHOULD BE THE SAME AS INPUTS RECEIVED BY THE RANGE (EXCEPT 


RORIGIN WHI 
INPUTS: 
DVP 
EXT 


112 ее 


OUTPUTS: 
КТТМЕ 


(12 


RORIGIN : 


CH IS USED TO MONITOR SIMULATION PROGRESS) 


THESTNDEXOOFOTHE DEPTH VELEOCITY PROFILE IO BE USED 
EXTRAPOLATION CONTROL FOR SUBROUTINE VELPRO 


ARRAY CONTAINING TRANSIT TIMES FROM A LOCATION TO A SENSOR 
DIMENSIONED AS FOLLOWS: (SENSOR,REGION,I) WHERE I-z1-4 THE 
TIMES FROM THE X,Y,Z,C PHONES RESPECTIVELY 
ARRAY CONTAINING THE TRUE LOCATION OF THE TARGET IN RANGE 
COORDINATES, DIMENSIONED: (REGION,I) I21-3 FOR X,Y,Z 

J.A. GEMBARSKI 

NPS 03/01/02 


DIMENSION XP(3),YP(3),ZP(3),CP(3),A(3),RTIME(0:57,27,4), 


& AR(3),XPHLOC(7,3), YPHLOC(7,3), ZPHLOC(7,3) , CPHLOC(7,3), 
5 RORIGIN(27,3),X(3) , ORIGIN(6,3), 
& L(300),VEL(300),V0(300),V1(300),LM(300),D2(300), 
& J(6),LINKS(18),SENSR(7),XS(18,3) 
COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 
INTEGER — SENSR,J,ERR,K,NR,H,KK,N,M, AR, LINKS,NSBL, S, 
& БР, МР, ТЕЗТ,ЕХТ, 1, РУР 
DOUBLE PRECISION ORIGIN,XS,XPHLOC,YPHLOC,ZPHLOC,CPHLOC,X,A 
DOUBLE PRECISION ONYO ZP CP AI A2, Pl, P2, VO, VI LM, L, VEL,DZ 
DOUBLE PRECISION TH1,TH2,RTIME, RORIGIN 
Шостедий TEST 
CHARACTER*15 NAME1 
DO 3 I=1,300 
Тук 2080 
VEL(I) = 0.0 
VO(I) = 0.0 
м = во 
Dz) <= 0.6 
LM(I) = 0.0 
3 CONTINUE 
ЕВЕ = 0 
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DO 30 S -0,57 
SENSR(1) з 5 


FIND THE CORRESPONDING OVERLAP REGIONS AND ADJACENT ARRAYS 


CALL FINDOVR(S,J,ERR) 
IF(ERR.EQ.1) GOTO 30 


МА = 1 
рО 10 ЕР « 1,6 
IF(J(LP).NE.0) NR=NR+1 
10 CONTINUE 
NR = NR-1 


ат 
| ии 
юэ > 


12 IF(J(K).NE.O) THEN 
LINKS(N)=1 
CALL OVERLAP (J(K),AR,ERR) 


DO 13 LP=1,3 
MP=1 
0 IF(SENSR(MP).NE.AR(LP))THEN 

TEST-.TRUE. 
МР-МР-1 

ELSE 
TEST=. FALSE. 

ENDIF 

IF(TEST.AND. MP.LT.KK) GOTO 11 


IF(TEST)THEN 
SENSR(KK)-AR(LP) 
LINKS (N+H) =KK 
KK=KK+1 
H=H+1 
ELSEIF(SENSR(1).NE.AR(LP) ) THEN 
LINKS (N+H)=MP 
H=H+1 
ENDIF 
13 CONTINUE 


H=1 

K=K+1 

N=N+3 

IF(K.LE.6) GOTO 12 
ENDIF 


FIND THE NUMBER OF SHORT BASE LINE POSLOC NSBL 
NSBL = N-1 
LOCATE THE TARGET POSLOC IN EACH CROSSOVER REGION 
DO 14 LP=1,NR 
CALL POINTST(J(LP),ORIGIN(LP,1),ORIGIN(LP,2),ORIGIN(LP, 3) ) 
DO 26 = 1,3 


RORIGIN(J(LP),H) = ORIGIN(LP,H) 
26 CONTINUE 


66 


14 CONTINUE 


* 


* IDENTIFY AN UNIQUE POSLOC FOR EACH ARRAY IN EACH CROSSOVER REGION 
* 
H-1 
DO 20 LP-1,NSBL 
XS(LP,1)-ORIGIN(H, 1) 
XS(LP,2)-ORIGIN(H,2) 
XS (LP, 3) s-ORIGIN(H, 3) 
IF(MOD(LP,3).EQ.0) H-H«1 
20 CONTINUE 
* 
C IDENTIFY THE GLOBAL COORDINATES OF EACH HYDROPHONE OF EACH SENSOR 
C TO CALCULATE THE TRUE TRANSIT TIMES 
* 
А2 + 0.0 
DO 21 LP=1, (KK-1) 
CALL ARRAY(SENSR(LP),X(1),X(2),X(3) ,A(1) ,A(2) , A(3) , ERR) 
GALI СВОВЕ(Х, А, ХР, УР, 7Р, СР) 


DO 22 N-1,3 
XPHLOC(LP,N)-2XP(N) 
УРНІОС (І.Р, М) ЗУР (М) 
2РНІОС (І.Р, М) З2Р (М) 
СРНІОС (ІР, М) “СР (М) 

22 CONTINUE 


ТЕ(ХР(3).СТ.А2)А2 = ХР(З) 
ТВ СШ А2)А2 - ҮР(3) 
ИЕ Це о слоја = ZP(3) 
IF(CP(3).GT.A2)A2 = CP(3) 


21 CONTINUE 


C RETRIEVE THE VELOCITY PROFILE INFORMATION 
* 
IF(EXT.NE.2)EXT - O 
CALL VELPRO(0,NAME1,DVP,EXT,A2) 
* 
С CALCULATE TRANSIT TIMES FROM EACH POSLOC TO EACH HYDROPHONE 
C THE SECOND INDEX ON TIME INDICATES THE HYDROPHONE: 1,2,3,4 FOR 
© X,Y,Z,C RESPECTIVELY (THIS INFORMATION IS NORMALLY SUPPLIED BY 
с THE RANGE) 
* 
Н = 1 
DO 25 LP-1,NSBL 
А1 = 0.000 
A2 = XPHLOC(LINKS(LP),3) 
Pl = DSQRT( (XS(LP,1)-XPHLOC(LINKS(LP),1))**2 + 
+ (XS(LP,2)-XPHLOC(LINKS(LP),2))**2  ) 
P2 = XS(LP,3) 
IEST + 0 


GALL RAYFIT?(Al,A2,P1,P2,M,VEL,LM,DZ,VO,V1, 
& RTIME(SENSR(LINKS(LP)),J(H),1),TH2, TH1, IEST) 


- YPHLOC(LINKS(LP),3) 

Р = DSQRT( (XS(LP,1)-YPHLOC(LINKS(LP),1))**2 + 

+ (XS(LP,2)-YPHLOC(LINKS(LP),2))**2 ) 
ТЕЗТ = 0 


CALI RAYEITI(Al,A2,P1,P2,M,VEL,LM,DZ, VO, V1, 
& RTIME(SENSR(LINKS(LP)),J(H),2), TH2, TH1, IEST) 


67 


A2 = ZPHLOC(LINKS(LP),3) 


Pl = DSQRT( (XS(LP,1)-ZPHLOC(LINKS(LP),1))**2 + 
+ (XS(LP,2)-ZPHLOC(LINKS(LP),2))**2  ) 
ТЕЗТ = 0 
CALL RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,VO,V1, 
& RTIME(SENSR(LINKS(LP)),J(H),3), TH2, TH1, IEST) 
A2 - CPHLOC(LINKS(LP),3) 
P1 - DSQRT( (XS(LP,1)-CPHLOC(LINKS(LP),1))**2 + 
+ (XS(LP,2)-CPHLOC(LINKS(LP),2))**2 ) 
IEST = 0 


CALL RAYFIT1(Al1,A2,P1,P2,M,VEL,LM,DZ,VO,V1, 
& RTIME(SENSR(LINKS(LP)),J(H),4), TH2, TH1, IEST) 


IF(MOD(LP,3).EQ.0) Hs H«1 
25 CONTINUE 
30 CONTINUE 


RETURN 
END 


68 
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SUBROUTINE SETUP(DVP,EXT,RTIME,RSHIFT,RSENSR,RLINKS,RJ,RDATA, 


& 


*X х » ж 


» 


INPUTS: 
DVP 
EXI 

RTIME 


ee ee ее 


BSHIFT > 


OUTPUTS: 
RSENSR : 


RLINKS 


RJ 


ее 


КОАТА : 


КЕККТАВ 


RXS 


ее 


ВМВ 


+ + + + + + + HF х F HF FF FF HF X X X X F Хх Хх ж HF Ж Хх X Хх Хх + ж» 


RERRTAB, RXS, RXL, RNR, ROBJ) 


THIS SUBROUTINE TAKES TRANSIT TIMES AND DVP INFORMATION FOR THE 
RANGE AND GENERATES THE RANGE ARRAYS RSENSR,RLINKS,RJ AND RDATA, 
RERRTAB FOR INPUT INTO THE RANGE CONTROL PROGRAM. 


THE DVP PROFILE CURRENTLY IN USE 

DVP EXTRAPOLATION CONTROL (2= DO NOT EXTRAPOLATE DVP) 
ARRAY HOUSING THE TRANSIT TIMES FROM SENSOR NUMBER 

(FIRST ELEMENT) TO REGION (SECOND ELEMENT) FOR HYDROPHONES 
X,YZ,C RESPECTIVELY (THIRD ELEMENT) 

ARRAY HOUSING SENSOR REPOSITIONING INFORMATION FOR SENSOR 
(FIRST ELEMENT) AND DIRECTION X,Y,Z,XTILT,YTILT,ZROT 
RESPECTIVELY (SECOND ELEMENT) 


ARRAY HOUSING THE CENTER SENSOR AND ITS TRIPLE OVERLAP 
SATELLITES (FIRST INDEX SENSOR, SECOND ARRAY SENSR(I)) 
ARRAY HOUSING THE LINKS(ENSOR) ARRAY FOR EACH SENSOR 
(FIRST ELEMENT) 
ARRAY HOUSING THE OVERLAP REGIONS ASSOCIATED WITH EACH 
SENSOR (FIRST INDEX) STORING J(I) ARRAY 
DATA ARRAY FOR RANGE CONTAINING PHS,PHL,THS,THL,HS,HL 
(THIRD INDEX) ARRAYS FOR A GIVEN CENTER ARRAY (FIRST 
INDEX) TO A GIVEN REGION (SECOND INDEX) 
ARRAY CONTAINING THE ERROR ARRAYS THER, PHER,HER, XER, YER, 
ZER (THIRD INDEX) FOR A GIVEN CENTER ARRAY (FIRST INDEX) 
TO A GIVEN REGION (SECOND INDEX) 
RANGE SBL ARRAY FOR THE GIVEN CENTER SENSOR (FIRST INDEX) 
TO A GIVEN REGION (SECOND INDEX) 
RANGE LBL ARRAY FOR THE GIVEN CENTER SENSOR REGION 
(FIRST INDEX) 
ARRAY CONTIANING NUMBER OF REGIONS ASSOCIATED WITH EACH 
CENTER SENSOR 

J.A. GEMBARSKI 

NPS 03/01/92 


DIMENSION XP(3),YP(3),ZP(3),CP(3),A(3),HOLD(6), 


Я» Я» Я» Я» Я» Я» Я» Я» е 


АН(3| «РНРОС(7,3|,ҮРНГОС(7,3),2РНЇОС(7,3),СРНГОС(7,3), 
xou x6. 3) X 03) 9  IMB(T8, 4); 
L(300),VEL(300),V0(300),V1(300),LM(300), 

DZ(300), SHIFT(7,6),RSHIFT(0:57,6),LINKS(18), 
NEW(3),THL(18),HS(18),SENSR(7),J(6), 
THS(18),HL(18),PHS(18),PHL(18),ERROR(7,6), 
RTIME(0:57,27,4) ,RSENSR(0:57,7),RLINKS(0:57,18), 
В7(0:57, 6), ВрРАТА(0:57, 27,6), ВЕВВТАВ(0:57, 27,6), 
RXS(0:57,27,3) , RXL(27,3) , RNR(0:57),ROBJ(0:57) 


COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 


INTEGER SENSR,J,ERR,K,NR,H,KK,N,M,AR,LINKS,NSBL,S, 

E LP,MP,EXT, 1,DVP,RJ,RLINKS, RSENSR, RNR 
* 

DOUBLE PRECISION Хе, ХЕ, ХВНЕОС, ТЕНГОС, 2РНГОС, СРНЪОС,Х, А 

DOUBLE PRECISION РТВ ЗЕ ВЕ МО Мас тм 1) МЕТ В? ЕТТМЕ, ВЗНТЕТ 

DOUBLE PRECISION NEW, THL, HOLD, RXS, RXL, RERRTAB, RDATA 

DOUBLE PRECISION TIME, PHS, PHL, HL, HS, THS, SHIFT, ERROR, ВОВУ, У! 
* 

LOGICAL TEST 
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ЖО 


*x 00 * 


т 


10 


51 


12 


Ша 


CHARACTER*15 МАМЕ1 
ERR = 0 
RETRIEVE THE VELOCITY PROFILE INFORMATION 


IF(EXT.NE.2)EXT = 0 
CALL VELPRO(1,NAME1,DVP,EXT,A2) 


5 + 15 
ро 50 з-ты 


РОМИ 2 
SENSR(I) = -1.0 
СОМТТМЈЕ 


5ЕМ58(1) з 5 


FIND THE CORRESPONDING OVERLAP REGIONS AND ADJACENT ARRAYS 
IF NONE EXIST SKIP THIS S(ENSOR) 


CALL FINDOVR(S,J,ERR) 
IF(ERR.EQ.1) THEN 
ROBJ(S) + -1.000 
сото 50 
ENDIF 


МВ = 1 
DO 10 LP = 1,6 
IF(J(LP).NE.0) NR=NR+1 


CONTINUE 
NR = NR-1 
RNR(S) = NR 
DO 51 I =1,6 
В2(б,1) = 2(Т) 
CONTINUE 
Hz1 
К-1 
КК-2 
N-1 


IF(J(K).NE.O)THEN 
LINKS(N)-1 
CALL OVERLAP(J(K),AR,ERR) 


ро 13 LP=1,3 

МР-1 

IF(SENSR(MP).NE.AR(LP))THEN 
TEST=.TRUE. 
MP=MP+1 

ELSE 
TEST=. FALSE. 

ENDIF 

IF (TEST. AND. MP.LT КК) СОТНИ 


IF (TEST) THEN 


SENSR(KK)-AR(LP) 
LINKS (N+H) =KK 
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» 


сос ССО 


жо 


КК-КК-1 
Н-Н-1 
ELSEIF(SENSR(1).NE.AR(LP) )THEN 
LINKS (N+H) =MP 
H=H+1 
ENDIF 
13 CONTINUE 


H=1 
К-К-1 
N=N+3 
IF(K.-LE.6) GOTO 12 
ENDIF 
DO 52 1-18 
RLINKS(S,I) = ІІМКЅ(І) 


52 CONTINUE 


DO 53 I =1,7 
IF(SENSR(I).EQ.-1) GOTO 53 
RSENSR(S,I) = SENSR(I) 


ao) CONTINUE 


FIND THE NUMBER OF SHORT BASE LINE POSLOC NSBL 


NSBL = N-1 

WRITE(90, 202) 

DO 40 I=1,18 
IF(I.LE.6)WRITE(90,203)I,SENSR(I),J(I),LINKS(I),LINKR(I) 
IF(I.EQ.7)WRITE(90,204)I,SENSR(I),LINKS(I),LINKR(I) 
IF(I.LE.12.AND.I.GT. 7)WRITE(90,205)I,LINKS(I),LINKR(I) 
IF(I.GT.12)WRITE(90,206)I,LINKS(I) 

40 CONTINUE 
CLOSE (UNIT=90) 


ESTABLISH INDUCED ERRORS FOR THE CENTER AND SATELLITE ARRAYS 


DO 21-17 
CALL RERROR(SENSR(I),HOLD,ERR) 
DO 8 H = 1,6 


ERROR(I,H) = HOLD(H) 
8 CONTINUE 
? CONTINUE 


RETRIEVE THE ARRAY SHIFT INFORMATION FOR PREVIOUS SHIFTS 


DÖ 7 I=1,7 
DO 6 H = 1,6 
SHIFT(I,H) = RSHIFT(SENSR(I),H) 
CONTINUE 
CONTINUE 
21 
DO 54 I -1,18 
IF(LINKS(I).EQ.0) GOTO 54 
DO 55 H = 1,4 


У с 
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» 


ж 


55 


54 


TIME(I,H) = RTIME(SENSR(LINKS(I)),J(K),H) 
CONTINUE 
IF(MOD(I,3).EQ.0) К + К+1 

CONTINUE 


PERFORM ARRAY SHIFTS FOR ALL SBL POSLOCS 


32 


Uer 


К = 1 
DO 77 I =1;,NSBL 


CALL ARRAY (SENSR(LINKS(I)),X(1),X(2),X(3),A(1), A(2) , A(3) , ERR) 


X(1) = X(1) + ERROR(LINKS(1),1) * SHIFT(DINKS(QB)DM 
X(2) = X(2) + ERROR(LINKS(I),2) + SHIFT(LINKS(I),2) 
X(3) = X(3) + ERROR(LINKS(I),3) + SHIFT(LINKS(I),3) 
А(1) з А(1) * ERROR(LINKS(I),4) * SHIFT(LINKS(I),4) 
А(2) = А(2) * ERROR(LINKS(I),5) * SHIFT(LINKS(I),5) 
А(3) з А(3) * ERROR(LINKS(I),6) * SHIFT(LINKS(I),6) 


LPs ПГНЕЗ Г) 
CALL ЄСВОВЕ(Х,/АСХР ҮР, 2Р ОР) 


DO 32 N=1,3 
XPHLOC(LP,N)sXP(N) 
YPHLOC(LP,N)sYP(N) 
ZPHLOC(LP,N)=ZP(N) 
CPHLOC(LP,N)sCP(N) 

CONTINUE 


IF(ERROR(LINKS(I),3).GT.O) THEN 

ТЕ СЕТ. МЕ 2) ХТ = 1 

CALL VELPRO(0,NAME1,DVP,EXT,X(3)) 
ENDIF 


CALL SHIFTER(X(3),A(1),A(2),A(3), TIME, I, NEN, HS(I), THS(I)) 


XS(I,1) = CPHLOC(LINKS(I),1) % МЕМ(1) 
XS(I,2) = CPHLOC(LINKS(I),2) + NEW(2) 
XS(I,3) = NEW(3) 


IF(MOD(I,3).EQ.0)THEN 
CALL LONG(TIME,LINKS,SENSR,CPHLOC,K,XS,HS, THS, THL, PHS, PHL,HL, 


XD 
K-K*1 
ENDIF 
CONTINUE 
BUILD THE RANGE ARRAYS 
K= 1 


DO 60 I = 1,NSBL 


RDATA(SENSR(LINKS(I)),J(K),1) = ТН5(1) 
RDATA(SENSR(LINKS(I)),J(K),2) = THL(I) 
RDATA(SENSR(LINKS(I)),J(K),3) » PHS(I) 
RDATA(SENSR(LINKS(I)),J(K),4) = РНІ(І) 
RDATA(SENSR(LINKS(I)),J(K),5) = HS(I) 
RDATA(SENSR(LINKS(I)),J(K),6) = НЫ(1) 
RXS(SENSR(LINKS(I)),J(K),1) = XS(I,1) 
RXS (SENSR(LINKS(I)),J(K),2) = Х5(1,2) 


ша 


60 


61 


62 


& 
& 


RXS (SENSR(LINKS(I)),J(K),3) = XS(I,3) 
RERRTAB(SENSR(LINKS(I)),J(K),1) » THL(I) - THS(I) 
RERRTAB(SENSR(LINKS(I)),J(K),2) » PHL(I) - PHS(I) 


RERRTAB(SENSR(LINKS(I)),J(K),3) HL(I) - HS(I) 
RERRTAB(SENSR(LINKS(I)),J(K),4) » XL(K,1) - XS(I,1) 
RERRTAB(SENSR(LINKS(I)),J(K),5) » XL(K,2) - XS(I,2) 
RERRTAB(SENSR(LINKS(I)),J(K),6) » XL(K,3) - XS(I,3) 


IF(MOD(I,3).EQ.O) K » K*1 


CONTINUE 
DO 61 K = 1,NR 
RXL(J(K),1) = XL(K,1) 
RXL(J(K),2) z XL(K,2) 
RXL(J(K),3) - XL(K,3) 
CONTINUE 
М = 0.000 


DO 62 1-1,НК 
W = н + DSQRT( (XL(I,3) -XS(3*I-2,3))**2 + 
(HL(3*I-2)-HS(3*I-2))**2 + 
(HS(3*I-2)*(PHL(3*I-2)-PHS(3*I-2)))**2) 
CONTINUE 
ROBJ(S) = W/REAL(NR) 


50 CONTINUE 


RETURN 
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APPENDIX C: COMPUTER PROGRAMS ERRFIX AND ANNEAL (AND SUPPORT PROGRAMS) 

Included with the FORTRAN programs ERRFIX and ANNEAL are the 
supporting programs NEWTILT and NEWERR.  NEWTILT is the tilt correction 
subcomponent of ERRFIX. NEWERR is a subroutine designed to calculate the 


new error values from a SHIFT and output them if desired. 


SUBROUTINE ERRFIX(TIME,J, LINKS, SENSR,DVP,EXT,NR,ORIGIN, XS,XL,THS, 
& THL, PHS, PHL, HS, HL, SHIFT, ERROR) 


THIS SUBROUTINE IS THE ARRAY POSITION (SHIFT 1,2,3) AND ORIENTATION 
(SHIFT 4,5,6) CORRECTION ALOGRITHM, MINIMIZING SBL AND LBL РОЗБОСЕН 


INPUTS: 
XS 2 ШЪВЕ РОБЕВС 5 
XL : LBL POSLOCS 
ТН5 : SBL ELEVATION ANGLES FROM C PHONE 
ІНІ  : LBL ELEVATION ANGLES FROM C PHONE 
PHS =: SBL AZIMUTHS 
PHL : LBL AZIMUTHS 
HS : SBL HORIZONTAL DISTANCES FROMeC PHONE 
HL : LBL HORIZONTAL DISTANCES FROM C PHONE 


SHIFT: CORRECTIONS APPLIED TO CENTER ARRAY A.C. PREVIOUSLY 
X,Y,Z ARE THE 1,2,3 ELEMENTS ;4,5,6 IDENTIFY THE TILTS 
схаванае нае) 

ERROR: THE INDUCED ERRORS TO THE SENSOR POSITIONS (GIVING 
OPERATIONAL POSITIONS) FIRST INDEX CORRESPONDS TO SENSR(I) 
THE SECOND TO THE TYPE (X,Y,Z,XTILT,YTILT,ZROT) 
OUTPUTS: 
SHIFT: X,Y,Z MOVEMENT (FEET) TO BE APPLIED TO ARRAY A.C. 
XTILT,YTILT,ZROT CORRECTIONS (RADIANS) TO BE APPLIED 
TIME,J,LINKS,SENSR,DVP,EXT,NR,ORIGIN : SENSOR ARRAY DATA 
RECEIVED FROM FORTRAN PROGRAM CONTROL 
XS,XL,PHS,PHL,THS,THL : UPDATED VALUES OF THESE VECTORS 
J.A. GEMBARSKI 
NPS 03/01/92 


ж ж ж + Ж Ж хх Ж ж Яя X ц хо хо ж ж ж + + 0X 0X 0X 0E ж» ж X X X 


* 


* 


DIMENSION XS(18,3),XL(6,3),THS(18), THL(18) , PHS(18), 
PHL(18),HS(18),HL(18),SHIFT(7,6),SENSR(7), 
ТНЕВ(6),РНЕВ(6),НЕВ(6),ХЕВ(6),ҮЕВ(6),2ЕВ(6),СРН(7,3), 
XPH(7,3) , YPH(7,3),ZPH(7,3), TIME(18,4),J(6),LINKS(18), 
L(300),VEL(300),V0(300),V1(300),D2(300),LM(300), 
ORIGIN(6,3),ERROR(7,6),X(3) ,A(3) , HOLD(7,6) 


рэ рэ ў? рэ ў? 


74 


* Q 


* С) 


COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 


DOUBLE PRECISION  XS,XL,THS,THL,PHS,PHL,HS,HL,TIME,SHIFT, TUNE1, 


я» Я» я» 


PHER, THER, HER, XER, YER, ZER, MI, MA, SUM,L,VEL,VO,V1,D2,LM, 
ORIGIN,X,A,CPH,ZFIX,XPH,YPH,ZPH,ERX,ERY,EPS,TUNE,ERROR, 
TUNE2, TUNE3,W,OBJ,HOLD 


INTEGER J,LINKS,SENSR,NR,EXT,I,M,DVP,C,HC,BAD 


LOGICAL CHECK1 


OBJ = 500.0D0 


BAD 


С 


= 0 


20:29 1=1,6 


HOLD(1,I) = 0.0D0 


29 CONTINUE 


UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 


CALL UPDATE (SENSR,DVP,EXT, SHIFT, ERROR,CPH,XPH, YPH, ZPH,X,A) 
CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP,EXT,NR,ORIGIN, 


& 


THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 


FORM ERROR ARRAYS 


DO 30 I=1,NR 


THER(I) » THL((3*I)-2) - THS((3*I)-2) 
PHER(I) » PHL((3*I)-2) - PHS((3*I)-2) 
HER(I) = HL((3*I)-2) - HS((3*I)-2) 
XER(I) = XL(I,1) - Х5((3*1)-2,1) 
YER(I) = XL(I,2) - XS((3*I)-2,2) 
ZER(I) » XL(I,3) - XS((3*I)-2,3) 
30 CONTINUE 
CHECK1 = .FALSE. 


222 


CONTINUE 


CALL FIND(PHER,NR,MI,MA) 


40 


80 


IF(MA.LT.O .OR. MI.GT.0) THEN 


SUM = 0.0 
DO 40 I=1,NR 

SUM = SUM + PHER(I) 
CONTINUE 


SHIFT(1,6) = SHIFT(1,6) - (SUM/REAL(NR) ) 


CALL NEWERR(C, TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP, EXT,NR,ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
CHECK1 = .TRUE. 
W = 0.0D0 
DO 80 I =1,NR 
W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + (HS(3*I-2) *PHER(I))**2) 
CONTINUE 
W = W/REAL(NR) 
GOTO 222 


ENDIF 
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60 


81 


82 


152 


IF(NR.EQ.6) THEN 


ZFIX = 0.0 
CALL FIND(THER,NR,MI,MA) 


IF(MA.LT.O .OR. MI.GT.O)THEN 


SUM = 0.0 
DO 60 I=1,NR 

SUM = SUM + ZER(I)/(REAL(NR) ) 
CONTINUE 

SHIFT(1,3) = SHIFT(1,3) + SUM 


CALL FIND(ZER,NR,MI, MA) 


CALL NEWERR(C,TIME,J,LINKS,SENSR, ERROR, SHIFT, DVP,EXT,NR, ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
CHECK1 = .TRUE. 
м = 0.000 
DO 81 I =1,NR 
W = W+ DSQRT(ZER(I)**2 + HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 
CONTINUE 
W = W/REAL(NR) 
GOTO 222 


ENDIF 


IF(C.EQ.O. BND-CHECKI ОЕТ СНЕС THEN 


CALL NEWTILT(SENSR,DVP,EXT, PHL, THL, PHS, THS NR ЗНОВ Пов вони м Б 


ERROR) 
SHIFT(1,4) = SHIFT(1,4) + ERX 
SHIFT(1,5) = SHIFT(1,5) + ERY 


CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP, EXT,NR,ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
CHECK1 = .FALSE. 
W = О.ОрО 
DO S2 г -1 МЕ 
Ч = W* DSQRT(ZER(I)**2 * HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 
CONTINUE 
W = W/REAL(NR) 
IF(W.LE.OBJ) THEN 
OBJ = W 
DO 182 I=1,6 
НС = С 
HOLD(1,I) « SHIFT(1,I) 
CONTINUE 
ВА” = 0 
ELSE 
BAD = BAD + 1 
ENDIF 
IF(BAD.GT.5) GOTO 444 


ENDIF 


TUNE = (C+1.0)/6.0 
IF(C.GE.15) TUNE = 3.0D0 
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ГЭЭ"... UNA m UA 


CALL FIND(YER,NR,MI,MA) 
ТЕ(МА.1Т.О .ОВ. MI.GT.O)THEN 
SUM + 0.0 
DO 63 I =1,NR 
SUM = SUM + YER(I)/(REAL(NR) ) 
63 CONTINUE 
TUNE1 = TUNE 
SHIFT(1,2) = SHIFT(1,2) + SUM*TUNE1 
CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT,DVP,EXT,NR,ORIGIN, 
& THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
СНЕСК1 = .TRUE. 
М = 0.000 
DO 83 I =1,NR 
W - W* DSQRT(ZER(I)**2 * HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 
83 | CONTINUE 
Я = W/REAL(NR) 
сото 222 
ЕКОТЕ 


CALL FIND(XER,NR,MI,MA) 
ШЕГМА 0 ОВ: МІ.СТ.О)ТНЕМ 
SUM = 0.0 
DO 64 I =1,NR 
SUM = SUM + XER(I)/(REAL(NR) ) 
64 CONTINUE 
TUNE2 = TUNE 
SHIFT(1,1) = SHIFT(1,1) + SUM * TUNE2 
CALL NEWERR(C, TIME, J,LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
& THER, PHER, HER, XER, YER, ZER, XS, XL, ТН5, THL, PHS, PHL, HS, HL) 
CHECK1 = .TRUE. 
М = 0.000 
DO 84 1 =1,NR 
W - W* DSQRT(ZER(I)**2 + HER(I)**2 + (HS(3*I-2) *PHER(I))**2) 
84 . CONTINUE 
У = W/REAL(NR) 
бОТО 222 
ENDIF 


CALL FIND(ZER,NR,MI,MA) 
IF(MA.LT.O .OR. МІ.СТ.О)ТНЕМ 
SUM = 0.0 
DO 65 I =1,NR 
SUM = SUM + ZER(I)/(REAL(NR) ) 
65 CONTINUE 
TUNE3 = TUNE*1.5 
SHIFT(1,3) = SHIFT(1,3) + SUM * TUNE3 
CALL NEWERR(C,TIME,J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT,NR, ORIGIN, 
& THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS,HL) 
CHECK1 = .TRUE. 
W = 0.0D0 
DO 85 I =1,NR 
W = W* DSQRT(ZER(I)**2 * HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 


7:7 
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CONTINUE 
W = W/REAL(NR) 
COTO 222 
ENDIF 
LOOK FOR Y CORRECTIONS 
SUM = 0.0 


66 


86 


DO 66 I =1,NR 

SUM = SUM + YER(I)/(REAL(NR)) 
CONTINUE 

ТОМЕ1 = ТОМЕ 

SHIFT(1,2) = SHIFT(1,2) + SUM*TUNE1 

CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP,EXT,NR, ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 

W = 0.0D0 
DO 86 I =1,NR 

W = W+ DSQRT(ZER(I)**2 + HER(I)**2 + (HS(3*I-2)*PHER(I))**2) 
CONTINUE 
W = W/REAL(NR) 
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SUM = 0.0 
DO 67 I =1,NR 
SUM = SUM + XER(I)/(REAL(NR)) 


CONTINUE 
TUNE2 = TUNE 
SHIFT(1,1) = SHIFT(1,1) + SUM * TUNE2 


CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP, EXT,NR, ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
я = 0.020 
DO 87 I =1,NR 
У - W* DSQRT(ZER(I)**2 + НЕВ(Т)**2 + (Н$(3*1-2)*РНЕВ(Т))**2) 
CONTINUE 
W - W/REAL(NR) 
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C 


DO 68 I =1,NR 
SUM = SUM + ZER(I)/(REAL(NR)) 
CONTINUE 
TUNE3 = TUNE 
SHIFT(1,3) = SHIFT(1,3) + SUM * TUNE3 
CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, SHIFT, DVP, EXT,NR, ORIGIN, 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, HS, HL) 
СНЕСК1 = „ТВОЕ. 
и = 0.000 
DO 88 I =1,NR 
У - W* DSQRT(ZER(I)**2 + HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 
CONTINUE 
W - W/REAL(NR) 


С + 1 


IF(C.LT.60 .AND. BAD.LE.5)GOTO 222 


444 WRITE(92,*) 
WRITE(92,*)'C',C,'BAD',BAD 


78 


WRITE (92,500)SHIFT(1,1),SHIFT(1,2),SHIFT(1, 3) 
WRITE (92,501)SHIFT(1,4),SHIFT(1,5),SHIFT(1,6) 
WRITE(92,*) HC 
WRITE (92,502)HOLD(1,1),HOLD(1,2),HOLD(1,3) 
WRITE (92,503)HOLD(1,4) ,HOLD(1,5) ,HOLD(1,6) 
DO 555 I=1,6 

SHIFT(1,I) » HOLD(1,I) 


555 CONTINUE 


500 FORMAT(10X,'PS11 


Е Р12 ‘в. 5, 2х, "Р513 ",ЕЭ.5) 


501 FORMAT(10X,'AS11 ',2X,F9.5,2X,'AS12 ',F9.5,2X,'AS13 ',F9.5) 


502 FORMAT(10X,'HS11 
503 FORMAT(10X,'HS11 


RETURN 
END 


ИО на о НЕО · E955, 2X, tHS13. ",F9.5) 
,2Х,29.5,2Х,'Н512 ',29.5,2Х,'Н513 ',F9.5) 
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SUBROUTINE ANNEAL(TIME,J,LINKS,SENSR,DVP,EXT,NR,ORIGIN,XS,XL, THS, 


& THL,PHS,PHL,HS,HL, SHIFT,ERROR, WMIN) 
* 
* THIS SUBROUTINE IS THE ARRAY POSITION (SHIFT 1,2,3) AND ORIENTATION 
* (SHIFT 4,5,6) CORRECTION ALOGRITHM, MINIMIZING SBL AND LBL POSLOCS 
* USING SIMULATED ANNEALING. 
* 
* — INPUTS: 
х XS : SBL POSLOCS 
* XL : LBL POSLOCS 
* ТН5 : SBL ELEVATION ANGLES FROM C PHONE 
х ТНГ : LBL ELEVATION ANGLES FROM C PHONE 
* PHS : SBL AZIMUTHS 
* PHL : LBL AZIMUTHS 
* HS SBL HORIZONTAL DISTANCES FROM C PHONE 
* HL LBL HORIZONTAL DISTANCES FROM C PHONE 
* SHIFT: CORRECTIONS APPLIED TO CENTER ARRAY A.C. PREVIOUSLY 
ж X,Y,Z ARE THE 1,2,3 ELEMENTS ;4,5,6 IDENTIFY THE TILTS 
* ШІ ҮТІПТ,2БОТ) 
х ERROR: THE INDUCED ERRORS TO THE SENSOR POSITIONS (GIVING 
х OPERATIONAL POSITIONS) FIRST INDEX CORRESPONDS TO SENSR(I) 
ж DOET SECOND TO ТІНЕ; ТҮРЕ (X,Y,2,XTILT,YTILT,ZROT) 
х WMIN : INITIAL GUESS TO THE MINIMUM OBJECTIVE FUNCTION VALUE 
х TIME,J,LINKS,SENSR,DVP,EXT,NR,ORIGIN  : SENSOR ARRAY DATA 
* RECEIVED FROM FORTRAN PROGRAM CONTROL 
* 
* — OUTPUTS: 
* SHIFT: X,Y,Z MOVEMENT (FEET) TO BE APPLIED TO ARRAY A.C. 
* XTILT,YTILT,ZROT CORRECTIONS (RADIANS) TO BE APPLIED 
х XS,XL,PHS,PHL,THS,THL : UPDATED VALUES OF THESE VECTORS 
к J.A. GEMBARSKI 
* 
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DIMENSION XS(18,3),XL(6,3),THS(18),THL(18),PHS(18), 


T3 


» 
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PHL(18),HS(18),HL(18),SHIFT(7,6),SENSR(7),SMHOLD(7), 
ТНЕВ(6),РНЕВ(6),НЕВ(6),ХЕВ(6),ҮЕВ(6),2ЕВ(6),СРН(7,3), 
XPH(7,3),YPH(7,3),ZPH(7,3),TIME(18,4),J(6),LINKS(18), 
L(300),VEL(300),V0(300),V1(300),DZ2(300),LM(300), 
ORIGIN(6,3),ERROR(7,6),X(3) ,A(3)  HOLD(7,6),Y(6),U(6) 


COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 


DOUBLE PRECISION XS,XL,THS,THL, PHS, PHL,HS,HL,TIME,SHIFT, 
PHER, THER, HER, XER, YER, ZER, SUM,L, VEL, VO,V1,DZ,LM, 
ORIGIN,X,A,CPH, XPH, YPH, ZPH, EPS, ERROR, SMALL, SMHOLD, 
HOLD,W,B,DELR1,G,WMIN,WO,W1,U,PI1,P,DELR2, ALPHA, DEL 

REAL У, У 


INTEGER J,LINKS,SENSR,NR,EXT,I,M,DVP,C, BAD, IX, NO, BAD1 
LOGICAL CHECK1,CHECK2,JUMP100, JUMP200 


PARAMETER DEFINITION 
IX SEED FOR THE RANDOM NUMBER GENERATORS 
BAD NUMBER OF SELECTED ‘WRONG’ STEPS MADE 
BAD1 NUMBER OF STEPS TRIED WITHOUT IMPROVING ON THE SMALLEST 
OBJECTIVE FUNCTION FOUND SO FAR 
ALPHA USED IN DETERMINING A NEW OBJECTIVE FUNCTION VALUE IF 
WMIN EQUALED OF SURPASSED 


B MULTIPLIER FOR DETERMINATION OF PROBABILITY OF ACCEPTING 
"WRONG' STEP 
G EXPONENT FOR INCREMENTAL OBJECTIVE FUNCTION CHANGE FOR 


DETERMINATION OF PROBABILITY OF ACCEPTING 'WRONG' STEP 
DELR1 MULTIPLIER FOR POSITIONAL STEP SIZE 
DELR2 MULTIPLIER FOR ANGULAR STEP SIZE 


NO = 6 

PI - DACOS(-1.0D0) 

EPS = 1.0D-4 

ВАР = 0 

ВАР = 0 

IX - 16806 

JUMP100 = .FALSE. 

JUMP200 = .FALSE. 

АГРНА = 0.400 

В = МВ#2.5 + ABS(NR-3) 
DELR1 = 0.011D0 
DELR2 = 7.7D-6 

G = 1.0D0 

WMIN = 0.0р0 

C ND 


UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 


CALL UPDATE(SENSR,DVP,EXT,SHIFT,ERROR,CPH, XPH,YPH, ZPH, X,A) 
CALL NEWERR(C,TIME,J,LINKS,SENSR,ERROR, SHIFT,DVP,EXT,NR,ORIGIN; 
THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHL, Hs), amy 


FORM ERROR ARRAYS 
DO 10 I=1,NR 


THER (I) 
РНЕВ (І) 


THL((3*I)-2) - THS((3*I)-2) 
PHL((3*I)-2) - PHS((3*I)-2) 
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» 


о 
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Q O00 0 0 


HER(I) » HL((3*I)-2) - HS((3*1)-2) 
ХЕК( Хорст ин XS((3*1I)-2,1) 
УЕВ(І) » XL(I,2) - XS((3*1)-2,2) 
ZER(I) » XL(I,3) - XS((3*1)-2,3) 


10 CONTINUE 
PRINT*, SHIFT(1,1),SHIFT(1,2),SHIFT(1,3) 
PRINT*, SHIFT(1,4),SHIFT(1,5),SHIFT(1,6) 


Ha ~ 
х 
| 
(л 
г 
н 
"rj 
= 
HA 
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DO 88 I = 1,NR 
IF(DABS(XS(3*I-1,2)-XS(3*I,2)).LT.0.01) THEN 


YER(I) » (XS(3*I-1,2)*XS(3*1,2) )/2.0 - XS(3*I-2,2) 

СНЕСК + „ТВОЕ. 
ELSE 

CHECK1 = .FALSE. 

YER(I) » (XS(3*I-1,2)*XS(3*I,2) *XL(I,2))/3.0 - XS(3*1-2,2) 
ENDIFC 
IF(DABS(XS(3*I-1,1)-XS(3*I,1)).LT.0.01) THEN 

СНЕСК2 = .ТЕЏЕ. 

XER(I) = (XS(3*I-1,1)+XS(3*I,1))/2.0 - XS(3*I-2,1) 
ELSE 

CHECK2 = .FALSE. 

XER(I) = (XS(3*I-1,1)+XS(3*I,1)+XL(I,1))/3.0 - Х5(3х1-2,1) 
ENDIF 
IF(CHECK1 .AND. CHECK2) THEN 

HER(I) = DSQRT(XER(I)**2 + YER(I)**2) 
ENDIF 
IF (DABS (XS(3*I-1,3)-XS(3*I,3)).LT.0.01) THEN 

ZER(I) = (XS(3*I-1,3)+XS(3*I,3))/2.0 - XS(3*I-2,3) 
ELSE 

ZER(I) » (XS(3*I-1,3)*XS(3*I,3)*XL(I,3))/3.0 - XS(3*1-2,3) 
ENDIF 


88 CONTINUE 


W = 0.0D0 
DO 80 I =1,NR 
W = W+ DSQRT(ZER(1)**2+HER(I) **2+(HS(3*I-2) *PHER(I))**2) 
80 CONTINUE 
WO = W/REAL(NR) 
CALCULATE NEW WMIN IF THE OBJECTIVE FUNCTION IS LESS THAN OR EQUAL 
TO THE INITIAL WMIN 
DEL = WO-WMIN 
IF(DEL.LT.0.0) THEN 
WMIN = WO + ALPHA*DEL 
IF(WMIN.LT.0.0) WMIN = 0.0 
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000000 


WRITE(91,*)'NEW WMIN',WMIN 
ELSEIF(DEL.LE.EPS .AND. DEDL2GT-O-O)ATHEN 
СОТО 555 
ENDIF 
SMALL - WO*2.0 


60 IF(BAD.GT.30) GOTO 555 
PRINT*,'WO',WO 
PRINT*,'BAD',BAD 
CALL LNORM(IX,Y,NO,1,0) 
SUM + 0.0 


DO 12 I = 1,6 
SUM = SUM + ABS(Y(I))**2.0DO 
12 CONTINUE 


DO 13 I=1,6 
U(I) = Y(1I)/SQRT(SUM) 
13 CONTINUE 
DO 14 I = 1,2 
HOLD(1,I) - 5НІЕТ(1,І) * DELR1*U(I) 
14 CONTINUE 
HOLD(1,3) = SHIFT(1,3) + 1.5*DELR1*U(3) 
DO 24 I = 4,5 
HOLD(1,I) = SHIFT(1,I) + DELR2*U(I) 
24 CONTINUE 
HOLD(1,6) = SHIFT(1,6) + 0.5*DELR2*U(6) 
CHECK FOR VALID STEPS 
IF(HOLD(1,4).LT. (-PI/2.0) .OR. HOLD(1,4).GT-(PI/2- 0) СОТЫ 
IF(HOLD(1,5).LT. (-PI/2.0) .OR. HOLD(1,5).GT.(PI/2.0)) GOTO 60 
IF(HOLD(1,6).LT. (-PI) .OR. HOLD(1,6).GT.(PI)) GOTO 60 


CALL NEWERR(C,TIME,J,LINKS, SENSR, ERROR, HOLD,DVP, EXT, NR, ORIGORG 
& THER, PHER, HER, XER, YER, ZER, XS, XL, THS, THL, PHS, PHU, aS ни 


DO 89 I = 1,NR 
IF(DABS(XS(3*I-1,2)-XS(3*I,2)).LT.0.01) THEN 
СНЕСК = .TRUE. 
YER(I) = (XS(3*I-1,2)+XS(3*I,2))/2.0 - XS(3*I-2,2) 
ELSE 
CHECK1 = .FALSE. 
YER(I) = (XS(3*I-1,2)+XS(3*I,2)+XL(1I,2))/3.0 - XS(3*1-2,2) 
ENDIF 
IF (DABS(XS(3*I-1,1)-XS(3*I,1)).LT.0.01) THEN 
CHECK2 = .TRUE. 
XER(I) = (XS(3*I-1,1)+XS(3*I,1))/2.0 – Х5(3*1-2,1) 
ELSE 
CHECK2 = .FALSE. 
XER(I) » (XS(3*I-1,1)*XS(3*I,1)*XL(I,1))/3.0 - XS(3*I-2,1) 
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ENDIF 
IF(CHECK1 .AND. CHECK2) THEN 

HER(I) = DSQRT(XER(I)**2 + YER(I)**2) 
ENDIF 


IF(DABS(XS(3*I-1,3)-XS(3*I,3)).LT.0.01) THEN 
ZER(I) = (XS(3*I-1,3)+XS(3*I,3))/2.0 - XS(3*I-2,3) 
ELSE 
ZER(I) » (XS(3*I-1,3)*XS(3*I,3)*XL(I,3))/3.0 - XS(3*1-2,3) 
ENDIF 
89 CONTINUE 


CHANGE THE STEP SIZING AND PROBABILITY CALCULATING PARAMETERS IF 
NOT IMPROVING THE OBJECTIVE FUNCTION 


DO 15 I =1,NR 
W - W* DSQRT(ZER(I)**2 + HER(I)**2 * (HS(3*I-2)*PHER(I))**2) 
15 CONTINUE 
W1 - W/REAL(NR) 


DELW = W1 - WO 
IF(WO.LE.SMALL .OR. W1.LE.SMALL) THEN 
ВАр = О 


IF(JUMP100 .AND. .NOT.JUMP200) THEN 
DELR1 = DELR1/1.5 
DELR2 = DELR2/1.5 


JUMP100 = .FALSE. 
ENDIF 
IF(JUMP100 .AND. JUMP200) THEN 
B = B/1.25 
JUMP100 = .FALSE. 
JUMP200 = .FALSE. 
ENDIF 


IF(WO.LE.W1) THEN 
DO 18 I=1,NR 
SMHOLD(I) = SHIFT(1,1) 
18 CONTINUE 
SMALL = WO 
ELSE 
DO 19 I=1,NR 
SMHOLD(I) = HOLD(1,1I) 
19 CONTINUE 
SMALL = Wl 
ENDIF 
ELSE 
ВАО1 = ВАО] + 1 
ЕМОТЕ 
IF(BAD1.EQ.100) THEN 
DELR1 -» DELR1*1.5 
DELR2 = DELR2*1.5 
JUMP100 = .TRUE. 
PRINT*, 'JUMP100' 
ELSEIF(BAD1.EQ.200) THEN 
B = B*1.25 
JUMP200 = .TRUE. 
PRINT*, 'JUMP200' 
ENDIF 
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ТЕ (ВА01 “ЕО 2500) 09129555 


IF(Wl.LE.WO) THEN 


DO 16 I = 1,6 
SHIFT(1,I) *» HOLD(1,I) 
16 | CONTINUE 


WO = Wl 


DEL = WO-WMIN 
IF(DEL.LT.0.0) THEN 
WMIN = WO + ALPHA*DEL 
IF(WMIN.LT.0.0) WMIN = 0.0 
ELSEIF(DEL.LE.EPS .AND. DEL.GT.0.0) THEN 
GOTO 555 


ELSE 


B 
O - 2.0*WO 
*DELW/(WO**G)).LT.-50.0) THEN 


P = EXP(-B*DELW/(WO**G) ) 
ENDIF 


CALL LRND(IX,V,1,1,0) 


IF(V.GE.P) THEN 
WRITE(91,*)'TAKE BAD STEP' 
С. с + 1 
сото 60 

ELSE 
WRITE(91,*)'TAKE BAD STEP' 
DOS та 0106 

SHIFT(1,I) *» HOLD(1,I) 
17 CONTINUE 

wo = Wl 
GOTO 60 

ENDIF 

ENDIF 


555 IF(BAD1.EQ.2500) THEN 
DO 20 I =1,NR 


SHIFT(1,I) з МНОГО (І) 
20 CONTINUE 
ENDIF 
WRITE(92,*)'C',C,' BAD1 ',BAD1 
WRITE (92, *) 


WRITE(92,500)SHIFT(1,1),SHIFT(1,2), SHIFT(1,3) 
WRITE(92,501)SHIFT(1,4),SHIFT(1,5),SHIFT(1,6) 
WRITE(92,*) 
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WRITE(92,*) 'SMALLEST ',SMALL 
WRITE(92,500)SMHOLD(1),SMHOLD (2), SMHOLD (3) 
WRITE(92,501)SMHOLD (4), SMHOLD(5) , SMHOLD(6) 
500 FORMAT(10X,'PS11 ',2X,F9.5,2X,'PS12 ',F9.5,2X,'PS13 ',F9.5) 
501 ҒОВМАТ(10Х,"А511 ',2X,F9.5,2X,'AS12 ',F9.5,2X,'AS13 ',F9.5) 


RETURN 
END 
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SUBROUTINE NEWTILT(SENSR,DVP,EXT,PHL,THL,PHS,THS,NR,SHIFT,ERX, 
& ERY, ERROR) 


SUBROUTINE TO ERRFIX 

FIND NEW POSITIONS OF THE X AND Y HYDROPHONES BASED ON TWO 
TILT ERRORS, THOSE CLOSEST TO THE Y AND X AXIS, THIS IS DONE 
BY FITTING A PLANE THROUGH THE NEW POINTS ALONG THE CHOSEN 
AZIMUTHS AND THEN BACKING OUT THE X,Y HYDROPHONE POSITIONS 


INPUTS: 

ERROR : ERROR ARRAY CONTAINING INDUCED ERRORS TO THE CENTER AND 
SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 
TILTS) 

SHIFT : ARRAY CONTAINING CORRECTIONS TO THE CENTER AND 
SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 
TIPOS 

SENSR : VECTOR DEFINING SENSOR ARRAY NUMBERS 

DVP,EXT: DVP IDENTIFIER (FROM CONTROL PROGRAM) AND EXTRAPOLATION 


CONTROL 
PHL,PHS,THL,THS : LBL AND SBL POSLOC INFORMATION 
NR : NUMBER OF OVERLAP REGIONS FOR THE INTERIOR ARRAY OF 
INTEREST 
OUTPUTS: ; 
ЕВХ : CORRECTION TERM FOR XTILT ANGLE (RADIANS) 
БЕТ : CORRECTION TERM FOR YTILT ANGLE (RADIANS) 


+ + + + + А Аа ии Ж А А ж хо хо хо F Хх Хх Хх Хх » Хх » ж 


DIMENSION PHL(18),SHIFT(7,6),X(3),Y(3),THL(18), 


& СО(3),ХРН(7,3),ҮРН(7,3),2РН(7,3),СРН(7,3),РН5(18), 
Е THS(18),ERROR(7,6),SENSR(7),PHER(6) 
DOUBLE PRECISION PHL,PI,ZROT,R,HOLD90,SHIFT,HOLDO,D,ERX, 
& G0) XPH, YPH, ZPH, CPH, X,Y, YTILTL, XTILTL,A,B,C,E,ERY, 
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E XHX,YHX,ZHX,XHY,YHY,ZHY,THL,PHS,THS,XTILTS, 
& YTILTS,ERROR,PHER,MA,MI 
INTEGER  MARK90,I,NR,MARKO,EXT,SENSR,DVP,K 


CALL UPDATE(SENSR,DVP,EXT,SHIFT,ERROR,CPH,XPH,YPH,ZPH,X,Y) 


ZROT = Ү(3) 

D = 30.0D0 

PI = DACOS(-1.0D0) 
МАВК90 = 0 

HOLD9O = 5.0*PI/6.0 
MARKO + 0 

HOLDO = 5.0*PI/6.0 


DO 10 I=1,NR 
IF (DABS (PHL(3*I-2)+ZROT) .LE. PI) THEN 
R = PHL(3*I-2) + ZROT 
ELSEIF (ZROT.GT.0.0) THEN 
R = PHL(3*I-2) + ZROT - 2.0*PI 
ELSE 
R = 2.0*PI + PHL(3*I-2) + ZROT 
ENDIF 


IF (DABS(R-PI/2.0).LT.HOLD90) THEN 
HOLD90 = DABS(R-PI/2.0) 
MARKSO = I 
ENDIF 
IF (DABS(R).LT.HOLDO) THEN 
HOLDO = DABS(R) 
MARKO = I 
ENDIF 


10 CONTINUE 


IF(MARK90.EQ.MARKO .AND. NR.GT.1)THEN 
IF((NR-MARKS0).GT.O)THEN 
MARKO = МАВКОО + 1 
ELSE 
MARKO 
ENDIF 
ELSEIF(NR.EQ.1)THEN 
PRINT*,'NOT ENOUGH REGIONS TO FORM A PLANE' 
PRINT*,'RETURN FROM NEWTILT' 
RETURN 
ENDIF 


MARK90 - 1 


IF (MARK90.EQ.0) THEN 
PRINT*,'ERROR IN Y AXIS LOCATION' 
STOP 

ELSEIF (MARKO.EQ.0)THEN 
PRINT*,'ERROR IN X AXIS LOCATION' 
STOP 

ENDIF 


poser 
CO(I) - 
12 CONTINUE 


3 
CPH(1,I) 


FORM THE PLANE THROUGH THE LBL ANGLES 
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X(1) = D*DCOS(PHL(3*MARK90-2) ) 
X(2) = D*DSIN(PHL(3*MARK90-2)) 
X(3) = -D*DTAN(THL(3*MARK90-2) ) 
Y(1) = D*DCOS(PHL(3*MARKO -2)) 
Y(2) = D*DSIN(PHL(3*MARKO -2)) 
Y(3) = -D*DTAN(THL(3*MARKO -2)) 


CALL PLANE(X,Y,CO,A,B,C,E) 
ХНХ = D*DCOS(-ZROT) % С0(1) 

ҮНХ = D*DSIN(-ZROT) % С0(2) 

ZHX = CO(3) - (-E-A*XHX-B*YHX) /C 
XTILTL = DASIN(ZHX/D) 


XHY 
ҮНҮ 
2НҮ 
YIILIC = 


D*DCOS (-ZROT+PI/2.0) * CO(1) 
D*DSIN(-ZROT*PI/2.0) % СО(2) 
CO(3) - (-E-A*XHY-B*YHY)/C 
DASIN(ZHY/D) 


FORM THE PLANE THROUGH THE SBL 
X(1) 
X (2) 
Х(3) 
Ү(1) 
Ү(2) 
Ү(3) 


D*DCOS(PHS(3*MARK90-2)) 
D*DSIN(PHS(3*MARK90-2)) 
-D*DTAN(THS(3*MARK90-2)) 
D*DCOS(PHS(3*MARKO -2)) 
D*DSIN(PHS(3*MARKO -2)) 
-D*DTAN(THS(3*MARKO -2)) 


CALL РБАНЕ(Х,Ү,СО,А,В,С,Е) 


XHX = D*DCOS(-ZROT) * CO(1) 

YHX = D*DSIN(-ZROT) + С0(2) 

ZHX = CO(3) - (-E-A*XHX-B*YHX)/C 
XTILTS = DASIN(ZHX/D) 

ХНУ = D*DCOS(-ZROT+PI/2.0) + CO(1) 
ҮНҮ = D*DSIN(-ZROT+PI/2.0) * CO(2) 
ZHY = CO(3) - (-E-A*XHY-B*YHY)/C 
YTILTS = DASIN(ZHY/D) 

ERX = (XTILTL-XTILTS) 

ERY = (YTILTL-YTILTS) 

RETURN 

END 
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+ + + + + + 


со (1) 
си 2) 
СО (3) 
CO(1) 
CO(2) 
CO(3) 


ANGLES 


+ + + + + + 


CO(1) 
O2 
CO(3) 
Go 
2012) 
СО(3) 


Ko oe oe oe oe ecce eee ccce e eee cc cc oe c oe ee ce Oc oe ce oec cec c oc ccc ce oec cc cc OC oe c cc eot oc e c oe eot ecc o o б x x x ж 


SUBROUTINE NEWERR(C,TIME,J,LINKS,SENSR,ERROR,SHIFT,DVP,EXT,NR, 
& ORIGIN,THER,PHER,HER,XER,YER,ZER,XS,XL,THS, THL, 
& PHS, PHL, HS, HD) 


THIS SUBROUTINE PERFORMS A SENSOR SHIFT FROM THE SHIFT ARRAY 
INFORMATION AND THEN CALCULATES A NEW LONGBASE POSLOC AND ERROR 
TABLE. CALLED FROM ERRFIX. 
INPUTS: 
С : OUTPUT CONTROL NUMBER, NUMBER OF ITERATIONS THROUGH 
ERRFIX SUBROUTINE 
ERROR : ERROR ARRAY CONTAINING INDUCED ERRORS TO THE CENTER AND 
SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; X,Y,Z 4-6; X,Y,Z 
ТОРТ) 
SHIFT : ARRAY CONTAINING CORRECTIONS TO THE CENTER AND 
SATELLITE SENSORS-FIRST ELEMENT CONTROLS WHICH SENSOR 
THE SECOND CONTROLS CORRECTION (1-3; Х,Ү,2 4-6; Х,Ү,7 
TILTS) 
TIME, LINKS, SENSR, J: INDIVIDUAL ARRAY VECTORS AS DEFINED IN\ 
SUBROUTINE SETUP FOR THE NANOOSE RANGE 
DVP,EXT: DVP IDENTIFIER (FROM CONTROL PROGRAM) AND EXTRAPOLATION 
CONTROL 
ORIGIN: TRUE TARGET POSITION, USED FOR COMPARATIVE ANALYSIS 
OUTPUTS: 


THER ELEVATION ANGLE ERROR (LBL - SBL) 
PHER AZIMUTH ANGLE ERROR (LBL - SBL) 
HER HORIZONTAL RANGE ERROR (LBL - SBL) 


YER Y COORDINATE ERROR (LBL - SBL) 
ZER Z COORDINATE ERROR (LBL - SBL) 
UPDATED VALUES FOR XS,XL,PHS,PHL,THS,THL,HS,HL 
J.A. GEMBARSKI 
NPS 01/01/92 


XER : X COORDINATE ERROR (LBL - SBL) 


Яя 3 ж х » + Ах ж Я А Хх + А HF хх хх хх хх хх Хх Хх » Хх + 


ж + ж 


DIMENSION CPH(7,3),THER(6),PHER(6),HER(6),XER(6), 


& YER(6),ZER(6),A(3),X(3),XS(18,3),XL(6,3), 

& THS(18),THL(18),PHS(18),PHL(18),HS(18),HL(18), 

& NEW(3),ORIGIN(6,3),SHIFT(7,6) , ERROR(7,6), SENSR(7), 

& XPH(7,3),YPH(7,3),ZPH(7,3), TIME(18,4),J(6),LINKS(18) 
DOUBLE PRECISION CPH,THER,PHER,HER, XER, YER, ZER, A, X,XS 
DOUBLE PRECISION ХРН,ҮРН,2РН 
DOUBLE PRECISION XL, THS, THL, ORIGIN, SHIFT, ERROR 
DOUBLE PRECISION PHS, PHL,HS,HL, TIME, NEW 


INTEGER KJ, LINKS, SENSR,; NR EXIT DVR C 


CALL UPDATE(SENSR,DVP,EXT,SHIFT, ERROR, CPH, XPH, YPH, ZPH,X,A) 
K -1 
по 10 1-1, о 


CALL SHIFTER(X(3),A(1),A(2),A(3), TIME, I, NEW, HS( I) THSIQDUD 


XS(I,1) = CPH(LINKS(1)7 1). >) NEWS 
Х5(1,2) = CPH(LINKS(I),2) + NEW(2) 
XS(I,3) = NEW(3) 

С WRITE(3,*) 'LONG FROM NEWERR' 


88 


Q00000000000000 


QQOOoooooodooo«doodododd 


CALL LONG ( 11 


ME, LINKS, SENSR, CPH, K, XS,HS, THS, THL, PHS, PHL, 


& HL, XL) 


THER(K) = 
PHER(K) = 
HER (K) 
XER (K) 
YER(K) 
ZER(K) 
IF(C.GT.16)THEN 
WRITE(91,*) 
WRITE(91,230 
М = (3*K)-2 
WRITE(91,231) 
WRITE(91,232) 
WRITE(91,233) 
WRITE(91,234) 
WRITE(91,235) 
WRITE(91,236) 
WRITE (91,237) 
WRITE(91,238) 
WRITE(91,239) 
WRITE(91,240) 
ENDIF 
Каз Кз 1 
10 СОМТТМОЕ 
IF(C.GT.14) THE 
WRITE(91,*) 
WRITE(91,250) 
WRITE(91,251) 
WRITE(91,*) 
WRITE(91,252) 
WRITE (91,*) 
WRITE(91,253) 
WRITE(91,*) 
WRITE(91,254) 
WRITE(91,*) 
WRITE(91,255) 
WRITE(91,*) 
WRITE(91,256) 
WRITE(91,*) 
WRITE (91,257) 
ENDIF 
RETURN 


"n n m І 


THL(I) 
PHL(I) 
HL(I) - 
XL(K,1) - 
XL(K,2) - 
XL(K,3) - 


- THS (1) 

- PHS(I) 

HS(I) 
XS(I,1) 
Х5(1:2) 
Х5(1,3) 


) J(K) 

(SENSR(LINKS(MP)),MPzN,N-*2) 
XSONOIDEXSTQN*IT,1),XS(N*2,1),XL(K,l),ORIGIN(K,1) 
XS(N,2),XS(N*1,2),XS(N*2,2),XL(K,2) , ORIGIN(K,2) 
XSTUNOS)AXSQNCETI,3),XS(N*2,3),XL(K,3),ORIGIN(K, 3) 
THS(N),THS(N+1),THS(N+2) 
THL(N),THL(N-*1),THL(N-*2) 
PHS(N),PHS(N+1),PHS(N+2) 
PHL(N),PHL(N+1),PHL(N+2) 


HS(N),HS(N+1),HS(N+2) 
HL(N),HL(N+1),HL(N+2) 


N 


(J (MP) ,MP=1,NR) 
(THER (MP) ,MP=1,NR) 
(PHER(MP) ,MP=1,NR) 
(HER(MP) ,MP=1,NR) 
(XER(MP) ,MP=1,NR) 
(YER(MP),MP-1,NR) 


(ZER(MP),MP-1, NR) 


FORMAT (25X, 'REGI 
FORMAT (2X, 3(3X, ' 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 
FORMAT (1X, 


НӘ” 
ТАБИ, 
РН, 
РНБ’, 
"Н5",4 
ІНЕ”, 4 


ЕОВМАТ(1Х, 
FORMAT (1X, 
FORMAT(1X, 
FORMAT(1X, 
FORMAT (1X, 


EDHERS 
' PHER' 
"НЕН", 
"ХЕК', 


ON T ра) 


ARRAY',1X,I2,1X,'SBL 
ОНОО ОДО БЭ) БХ 9.2, 3х, го. 2} 
ин 1 9.2, 2,9. 2, 5х, Е9.2, 3х, Е9. 2} 
'Z',4X,F9.2,2(7X,F9.2),5X, F9.2,3X, F9.2) 
3Х,Е8.5,2(8Х,Е8.5),5Х,Е8.4,3Х,Е8.4) 
3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
X. F8.2,2(8X,F8.2),5X,F8.2,3X,F8.2) 
X,F8.2,2(8X,F8.2),5X,F8.2,3X,F8.2) 
FORMAT(15X,'CENTER ARRAY ERROR ANALYSIS') 

' REGION' ,5X, 12,5 (8X, I2)) 


,2X,6(2X,F8.5)) 
,2X,6(2X,F8.5)) 
3X,6(2X,F8.4)) 
2X,6(2X,F8.3)) 
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13 3X  "BONGBASE',6X, ' GOAL ' ) 


256 FORMAT(1X,'YER',2X,6(2X,F8.3)) 
257 FORMAT(1X,'2ER',2X,6(2X,F8.3)) 
END 


90 


APPENDIX D: COMPUTER PROGRAM CONTROL 
This is the main driving program of the error correction methodology. 
Additional control lines have been added than are presented in the 
logic flow chart (Figure 11). These control lines were needed during 
multiple sensor array correction attempts. The nature of the control 
structure is to determine the entry into ANNEAL. The entry requirements 
into ANNEAL have also been changed (from objective function value 0.5 to 
во). This enabled faster solution convergence by preceding to ANNEAL 


quicker. 


PROGRAM CONTROL 


THIS PROGRAM CONTROLS THE ERROR CORRECTION SCHEME FOR THE NANOOSE 
RANGE. 
A SIMULATION START (SIMSTRT) SUBROUTINE GENERATES TRANSIT TIMES FOR 
EACH SENSOR IN THE RANGE TO ITS TRIPLE OVERLAP REGIONS R(ANGE)TIME 
(THIS INFORMATION IS NORMALLY PROVIDED BY THE RANGE). 
SENSOR OPERATIONAL POSITION (ERROR INDUCED FROM THE ACTUAL POSITION) 
IS CREATED THROUGH THE RANGE ERROR (RERROR) SUBROUTINE. SENSOR 
ACTUAL POSITION IS FOUND IN THE SUBROUTINE ARRAY. 
J.A. GEMBARSKI 
NPS 03/01/92 
DIMENSION HOLD(6),XPHLOC(7,3),YPHLOC(7,3), ZPHLOC(7,3) , CPHLOC(7,3), 
ORIGIN(6,3),XS(18,3),XL(6,3),RLINKS(0:57,18),J({6), 
1,.(300) ,УЕТ, (300) ,У0 (300) VI 200), LM(300), RORIGIN(27;3), 
DZ(300),SHIFT(7,6),RSHIFT(0:57,6),YER(6),ZER(6), 
THL(18),HS(18),THER(6),PHER(6),HER(6), XER(6) , SENSR(?), 
THS(18),HL(18),PHS(18),PHL(18),ERROR(7,6),LINKS(18), 
RTIME(0:57,27,4) , RSENSR(0:57,7), TIME(18,4),CHECKA(0:57), 
RJ(0:57,6) , RNR(0:57), RDATA(0:57,27,6) , ROBJ(0:57),W1(7), 
RERRTAB(0:57,27,6) ,RXS(0:57,27,3) , RXL(27,3) , MARK(0:57) 


+ + + + + + + ж Хх + + X 


е ў е е ў ў ў б? 


COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 


INTEGER SENSR,J,ERR,K,NR,H,N,M, LINKS, RJ,RLINKS, RNR, RSENSR,S, 
jt MP,EXT,I,DVP,SS,NRS,MARK,MA 


DOUBLE PRECISION ОВБТСЕЦ КВ ХО, ХЕНЕОС, РНЬОС, 2РНЕОС,СРНЬОС ,ХЕК 
DOUBLE PRECISION VO,V1,LM,L,VEL,DZ, RDATA, RERRTAB, THER, YER, ZER 
DOUBLE PRECISION THL, HOLD, PHER, HER, RORIGIN, RSHIFT,RTIME, ROBJ 
DOUBLE PRECISION TIME, PHS, PHL,HL,HS,THS, SHIFT, ERROR, RXS, RXL,W 
DOUBLE PRECISION MAX, TOL,WMIN,W1 


LOGICAL CHECKA, CHECKO, MKANN 


C INITIALIZATION 


J1 


DO 3 I-1,300 
L(I) 
VEL(I) 
VO(I) 
У1(1) 
DZ(I) 
LM(I) 


пинин и 


ООООООО ж 


Q 


QOO * 


IF(I.LE.5 


ооооооо 
OOOOOO 


) CHECKA(I-1) = .FALSE. 


CONTINUE 


DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 
DATA 


THS/18*0/ 
THL/18*0/ 
PHS/18*0/ 
PHL/18*0/ 
HS/18*0/ 
HL/18*0/ 
XS/54*0/ 
XL/18*0/ 
SHIFT/42*0/ 
XPHLOC/21*0/ 
YPHLOC/21*0/ 
ZPHLOC/21*0/ 
CPHLOC/21*0/ 
RSHIFT/348*0/ 
RTIME/6264*0/ 
RDATA/9396*0/ 
RSENSR/406*-1/ 
RORIGIN/81*0/ 


DATA 
ERR = О 
ФОН-а 
МА = 58 


MARK/58*0/ 
00-4 
CHOSE THE DVP TO BE USED O 


Вы? 
0.04 


ISOSPEED - 1 
ISOGRADIENT 
ISOGRADIENT 
0.06 ISOGRADIENT 
0.08  ISOGRADIENT 
0.083 ISOGRADIENT 
REAL WATER COLUMN - 


лїп н ПО 
| 
о 


DVP = 10 


TO CANCEL THE DVP EXTRAPOLATION SET ЕХТ ТО 2 
EAT C= 2 


OPEN(UNIT=3,FILE='/LONG OUT A') 
OPEN (UNIT=44,FILE='/REC METHOD A’) 
OPEN (UNIT=90, FILE='/INFO TSTR A') 
OPEN (UNIT=91,FILE='/DATA TSTR T') 
OPEN(UNIT=92,FILE='/VALID BIG T) 
666 CALL SIMSTRT(DVP,EXT,RTIME,RORIGIN) 
CALL SETUP(DVP,EXT,RTIME,RSHIFT,RSENSR,RLINKS,RJ,RDATA, 
& RERRTAB, RXS,RXL, RNR, ROBJ) 
MKANN = .FALSE. 
999 MAX = O.ODO 
CHECKO = .TRUE. 
рО 4021-0501 
IF(ROBJ(I).EQ.-1.0) GOTO 40 
IF(ROBJ(I).GT.5.0DO) PRINT*,'CHECK FOR',I 


IF(ROBJ(I).GT.1.0 .AND. .NOT.MKANN .AND. RNR(I).EQ.6) THEN 
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PRINT*,'OBJ PREVENTIN ANNEAL',I,ROBJ(I) 
CHECKO = .FALSE. 
ENDIF 
ТЕ (МА.ЕО.Т) СОТО 40 
IF(ROBJ(I).GE.MAX .AND. ROBJ(I).GT.TOL .AND. (RNR(I).EQ.6))THEN 
5 = І 
MAX - ROBJ(I) 
ENDIF 
40 CONTINUE 
PRINT*,'S IN CONTROL',S 


C RETRIEVE RANGE INFORMATION ARRAYS FROM SETUP SUBROUTINE 
* 
PRINT*,'BEFORE ERRFIX/ANNEAL' 
DO 5 I = 1,7 
SENSR(I) = RSENSR(S,I) 
PRINT*,'OBJ',SENSR(I),ROBJ(SENSR(I)) 
5 CONTINUE 
DO 4 I 21,18 
LINKS(I) » RLINKS(S,I) 
4 CONTINUE 
* 
C ESTABLISH INDUCED ERRORS FOR THE CENTER AND SATELLITE ARRAYS 
* 
БО 9 1-1,7 
IF(SENSR(I).EQ.-1) GOTO 9 
CALL RERROR(SENSR(I),HOLD,ERR) 
DO 8 H = 1,6 
ERROR(I,H) = HOLD(H) 
8 CONTINUE 
9 CONTINUE 
* 
C RETREIVE THE ARRAY SHIFT INFORMATION FOR PREVIOUS SHIFTS 
* 


DO 7 1-1,7 
IF(SENSR(I).EQ.-1) GOTO 7 
DO 6 H = 1,6 
SHIFT(I,H) = RSHIFT(SENSR(I),H) 
IF(I.EQ.1) J(H) = RJ(S,H) 


6 CONTINUE 
1 CONTINUE 
К = 1 


DO 10 Í= 1,18 
DO 11 H = 1,4 
TIME(I,H) = RTIME(SENSR(LINKS(I)),J(K),H) 


Т CONTINUE 
IF(MOD(I,3).EQ.O)K + к+1 
10 CONTINUE 


NR = RNR(S) 


DO 13 I = 1,6 
DO 14 H = 1,3 
ORIGIN(I,H) = RORIGIN(J(I),H) 
14 CONTINUE 
13 CONTINUE 
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* С) 


20 


21 


ПИ 


RETREIVE THE WORKING ARRAYS FROM THE RANGE ARRAYS 


KM 
DO 20 I = 1,1 
THS(I) 
THL(I) 
PHS(I) 
PHL(I) 
HS(I) 
HL(I) 
Х5(1 1) 
Ха 2) 
XS(I,3) 
IF(MOD( 
CONTINUE 


11111111 


"З 


DO 21 I = 
THER(I) 
PHER(I) 

HER(I) 
XER(I) 
YER(I) 
ZER(I) 
SUM 
XIL 2) 
XL (1,3) 
CONTINUE 


‚ 6 


uH www My 


WRITE(92,220) 
WRITE(92,221) 
WRITE(92,222) 
WRITE(92,223) 
WRITE(92,224) 
WRITE(92,225) 
WRITE(92,226) 
WRITE(92,227) 
WRITE(92,228) 


8 


RDATA(SENSR(LINKS(I)),J(K),1) 
RDATA(SENSR(LINKS(I)),J(K),2) 
RDATA(SENSR(LINKS(I)),J(K),3) 
RDATA(SENSR(LINKS(I)),J(K),4) 
RDATA(SENSR(LINKS(I)),J(K),5) 
RDATA(SENSR(LINKS(I)),J(K),6) 
RXS(SENSR(LINKS(I)),J(K),1) 
RXS(SENSR(LINKS(I)),J(K),2) 
RXS(SENSR(LINKS(I)),J(K),3) 


).EQ.O) K » K*1 


RERRTAB(S,J(I),1) 
RERRTAB(S,J(I),2) 
ВЕВВТАВ(5,0(1),3) 
RERRTAB(S,J(I),4) 
RERRTAB(S,J(I),5) 
RERRTAB(S,J(I),6) 


RXL(J(I),1) 
RXI SUIS 2) 
В, 


(SENSR(N),N=1,7) 


(ЕВВОВ(М,1), 
(ЕВВОВ(М,2), 
(ЕВВОВ(М,3), 
(ERROR(N,4), 
(ERROR(N,5),N 
(ERROR(N,6),N=1 


Z ZZZ 
u uw t 
юр ьо ке 


~ ~ ~ ~ ~ ~ 


DO 77 K = ТАМЕ 


ИЕТТЕ (92, #) 


WRITE(92,230) J(K) 


N - (3*K)-2 


WRITE(92,231) 
WRITE(92,232) 
WRITE(92,233) 
WRITE(92,234) 
WRITE(92,235) 
WRITE(92,236) 
WRITE(92,237) 
WRITE(92,238) 
WRITE(92,239) 
WRITE(92,240) 


CONTINUE 


WRITE(92,*) 
WRITE(92,*) 
WRITE(92,250) 
WRITE(92,251) (J 


(SENSR(LINKS(MP)),MP-zN,N«*2) 
XS(N,1),XS(N*1,1),XS(N*2,1),XL(K,1) , ORIGIN(K, 1) 
XS(N,2),XS(N*1,2),XS(N*2,2), XL(K,2) ,  ORIGIN(K,2) 
XS(N,3),XS(N+1,3),XS(N+2,3),XL(K,3),ORIGIN(K, 3) 
THS(N),THS(N+1),THS(N+2) 
THL(N),THL(N+1),THL(N+2) 

PHS(N), PHS(N+1),PHS(N+2) 
PHL(N),PHL(N*1),PHL(N*2) 

Н5(М),Н5(М41),Н5(МФ2) 

HL(N),HL(N*1),HL(N*2) 


(МР),МР-1,МВ) 
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ИЕТТЕ (92, г) 


WRITE(92,252) ((THL(3*MP-2)-THS(3*MP-2)),MP-1,NR) 
WRITE(92,*) 

WRITE(92,253) ((PHL(3*MP-2)-PHS(3*MP-2)),MP-1,NR) 
WRITE(92,*) 

WRITE(92,254) ((HL(3*MP-2)-HS(3*MP-2)),MP-1,NR) 
WRITE(92,*) 

WRITE(92,255) ((XL(MP,1)-XS((3*MP)-2,1)),MP=1,NR) 


WRITE(92,*) 
WRITE (92,256) 
WRITE(92,*) 
WRITE (92,257) 


( (XL(MP,2)-XS((3*MP)-2,2) ), MP21, NR) 
( (XL(MP,3)-XS((3*MP)-2,3)), MP21,NR) 


DO 19 I=1,6 
HOLD(I) = 
19 CONTINUE 


SHIFT(1,I) 


IF(.NOT. CHECKO) THEN 
CALL ERRFIX(TIME,J,LINKS,SENSR,DVP,EXT,NR,ORIGIN,XS,XL,THS,THL, 
& РН5$,РНЇ1,,Н5,Н1,,5НТЕТ,ЕВКОВК) 
ENDIF 


CALL EVAL(RDATA,RERRTAB,SENSR,LINKS,RNR,RJ,PHS,PHL,HL,HS, 
& XS,XL,W1) 


IF (CHECKO) THEN 

PRINT*,'PRE-ANNEAL MARK',S,MARK(S) 

WMIN + 0.000 

DO 22 I= 2,7 
IF(SENSR(I).EQ.-1 
IF(ROBJ(SENSR(I)).GT.WMIN) WMIN = 

22 CONTINUE 

WMIN = WMIN/2.0 

PRINT*, 'TO ANNEAL',S, 'WMIN',WMIN 

CALL ANNEAL(TIME,J, LINKS, SENSR, DVP, EXT,NR, ORIGIN, XS, XL, THS, THL, 


.АМП. RNR(I).NE.6) GOTO 22 
ROBJ(SENSR(I)) 


& PHS,PHL,HS,HL,SHIFT,ERROR,WMIN) 
MKANN = .TRUE. 
МА - 5 
23 ENDIF 
OUTPUT THE NEW (CORRECTED) POSLOC DATA 


WRITE(92,*) 
WRITE(92,230) 
М = (3*K)-2 
WRITE(92,231) 


J(K) 


(SENSR(LINKS (MP) ), MPZN,N*2) 


WRITE(92,232) 
WRITE(92,233) 
WRITE(92,234) 
WRITE(92,235) 
WRITE(92,236) 
WRITE(92,237) 
WRITE(92,238) 
WRITE(92,239) 
WRITE(92,240) 


78 CONTINUE 


XS(N,1),XS(N*1,1),XS(N*2,1),XL(K,1),ORIGIN(K, 1) 
XS(N,2),XS(N+1,2),XS(N+2,2),XL(K,2), ,ORIGIN(K,2) 
КЕСУУ ХОСИ ЕТУ Х51(Н-2,23),ХТҮК,3),ОВТСТМ(К,3) 
THS(N), THS(N*1),THS(N*2) 
THL(N),THL(N*1),THL(N-*2) 
PHS(N),PHS(N+1),PHS(N+2) 
PHL(N),PHL(N-*1),PHL(N-*2) 

HS(N),HS(N+1),HS(N+2) 

HL(N),HL(N+1),HL(N+2) 
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34 
33 


60 


61 


42 


WRITE(92,*) 

WRITE(92,*) 

WRITE(92,250) 

WRITE(92,251) (J(MP),MP-1,NR) 

WRITE(92,*) 

WRITE(92,252) ((THL(3*MP-2)-THS(3*MP-2) ),MP=1,NR) 
WRITE(92,*) 

WRITE(92,253) ((PHL(3*MP-2)-PHS(3*MP-2)),MP-1,NR) 
WRITE(92,*) 

WRITE(92,254) ((HL(3*MP-2)-HS(3*MP-2)),MPz1,NR) 
WRITE(92,*) 

WRITE(92,255) ((XL(MP,1)-XS((3*MP)-2,1)),MP=1,NR) 
WRITE(92,*) 

WRITE(92,256) ((XL(MP,2)-XS((3*MP)-2,2)),MP=1,NR) 
WRITE(92,*) 

WRITE(92,257) ((XL(MP,3)-XS((3*MP)-2,3)),MP=1,NR) 


DO 33 I =1,7 
IF(SENSR(I).EQ.-1) GOTO 33 
DO 34 H =1,6 


RSHIFT(SENSR(I),H) = SHIFT(I,H) 
CONTINUE 
CONTINUE 

K= 1 

DO 60 I = 1,18 
RDATA(SENSR(LINKS(I)),J(K),1) » THS(I) 
RDATA(SENSR(LINKS(I)),J(K),2) є ТНІ(І) 
RDATA(SENSR(LINKS(I)),J(K),3) = PHS(I) 
RDATA(SENSR(LINKS(I)),J(K),4) = РНІ (І) 
RDATA(SENSR(LINKS(I)),J(K),5) » HS(I) 
RDATA(SENSR(LINKS(I)),J(K),6) є НЫ(1) 
RXS(SENSR(LINKS(1)),J(K),1) = Х5(1,1) 
RXS(SENSR(LINKS(I)),J(K),2) = XS(I,2) 
RXS(SENSR(LINKS(I)),J(K),3) = XS(I,3) 
RERRTAB(SENSR(LINKS(I)),J(K),1) = THL(I) - THS(I) 
RERRTAB(SENSR(LINKS(I)),J(K),2) з PHL(I) - PHS(I) 
RERRTAB(SENSR(LINKS(I)),J(K),3) » HL(I) - HS(I) 
RERRTAB(SENSR(LINKS(I)),J(K),4) = XL(K,l1) - Х5(І,1) 
RERRTAB(SENSR(LINKS(I)),J(K),5) з XL(K,2) - XSI 2) 
RERRTAB(SENSR(LINKS(I)),J(K),6) = XL(K,3) - х5(1,3) 
ТЕ (МОО (1,3).ЕО.0) К + К+1 

CONTINUE 

DO 61 K = 1,6 
RXL(J(K),1) s. YE(K ПК 
RYE eRe) = XL(K,2) 
RXL(J(K),3) - XL(K,3) 

CONTINUE 

MARK(S) » MARK(S) 4 1 


роди ка В) 
IF(SENSR(K).EQ.-1) GOTO 41 
SS - SENSR(K) 
W - 0.000 
DO 42 I=1,RNR(SS) 
Ч = W * DSQRT( (RERRTAB(SS,RJ(SS,I),6))**2 + 
(RERRTAB(SS,RJ(SS,I),3))**2 4 


(RDATA(SS,RJ(SS,I),5)*RERRTAB(SS,RJ(SS,1),2)) **2) 


CONTINUE 
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ROBJ(SS) = W/REAL(RNR(SS) ) 
PRINT*, 'OBJ',SS,ROBJ(SS) 
CONTINUE 
PRINT*, ‘MARK ',S,MARK(S) 


IF(MARK(S).LT.10) GOTO 999 
STOP 


FORMAT (11X, 'CENTER',20X, 'ADJACENTS' ) 

FORMAT (1X, ‘ARRAYS',6X,12,9X,12,5(6X,I2)) 

FORMAT (/,1X,'SHIFTS') 

FORMAT (3X, 'DELX', 4X,F8.4,2X,6(1X,F8.4) ) 

FORMAT (3X, 'DELY',4X,F8.4,2X,6(1X,F8.4) ) 

FORMAT (3X, 'DELZ',4X,F8.4,2X,6(1X,F8.4) ) 

FORMAT (3X, 'DXTILT',2X,F8.4,2X,6(1X,F8.4) ) 

FORMAT (3X, 'DYTILT',2X,F8.4,2X,6(1X,F8.4)) 

FORMAT (3X, ‘DZROT',3X,F8.4,2X,6(1X,F8.4)) 
FORMAT(25X,'REGION  ',I2) 
FORMAT(2X,3(3X, ' ARRAY',1X,I2,1X,'SBL '),3X,'LONGBASE',6X, 'GOAL') 
FORMAT(1X,'X',4X,F9.2,2(7X,F9.2),5X,F9.2,3X,F9.2) 
FORMAT(1X,'Y',4X,F9.2,2(?7X,F9.2), 5X, F9.2, 3X, F9.2) 
FORMAT(1X,'Z',4X,F9.2,2(7X,F9.2),5X,F9.2,3X,F9.2) 
FORMAT (1X,'THS',3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
FORMAT(1X, THL',3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
FORMAT(1X,'PHS',3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
FORMAT(1X,'PHL',3X,F8.5,2(8X,F8.5),5X,F8.4,3X,F8.4) 
FORMAT(1X,'HS',4X,F8.2,2(8X,F8.2),5X,F8.2,3X,F8.2) 
FORMAT(1X,'HL',4X,F8.2,2(8X,F8.2),5X,F8.2,3X, F8.2) 
FORMAT(15X,'CENTER ARRAY ERROR ANALYSIS") 
FORMAT(1X,'REGION',5X,12,5(8X,12)) 
FORMAT(1X,'THER',2X,6(2X,F8.5)) 
FORMAT(1X,'PHER',2X,6(2X,F8.5)) 
FORMAT(1X,'HER',3X,6(2X,F8.4)) 
FORMAT(1X,'XER',2X,6(2X,F8.3)) 

FORMAT (1X, 'YER',2X,6(2X,F8.3)) 
FORMAT(1X,'ZER',2X,6(2X,F8.3)) 


END 


э] 


APPENDIX E: COMPUTER PROGRAMS - GENERAL RANGE AND SYSTEM SUPPORTING 
This appendix contains the following FORTRAN programs: 
UPDATE, FIND, PLANE, RAYFIT (formally RAYFIT1), ISOGAD (formally ISGRAD1), 


ARRAY, FINDOVR, OVERLAP, POINTST, GLOBE, RERROR. 


SUBROUTINE UPDATE(SENSR,DVP,EXT,SHIFT,ERROR,CPH,XPH,YPH,ZPH, 
& PU,AU) 


* THIS SUBROUTINE UPDATES THE POSITION OF THE HYDROPHONES FOR THE 
* CENTER ARRAY AND ALL OF ITS SATELLITE ARRAYS. POSITIONS ARE 
* PROVIDED IN GLOBAL RANGE COORDINATES. 
* J.A. GEMBARSKI 
* МР5 01/10/92 
Ж а = — «= «= —A -— спо спо спо нз а= = ә ш» а Янь «=з а> аз аз а» а ә = чив эи е m чи» анж чив ань -- um —„ а а а 
* INPUTS: 
х SENSR : 7 ELEMENT ARRAY CONTAINING CENTER (1) AND SATELLITE 
* (2-7) SENSOR NUMBERS 
* EXT : EXTRAPOLATION CONTROL FOR DVP PROFILE 1-EXTRAPOLATE 
х IF NEEDED, 2- DO NOT EXTRAPOLATE 
х SHIFT : ARRAY CONTAINING SHIFTS TO BE PREFORMED ON CENTER AND 
х SATELLITE ARRAYS (FIRST ELEMENT) IN THE X,Y,Z (SECOND 
х ELEMENT, 1-3) AND THE XTILT,YTILT,ZROT (4-6) 
х ERROR : ARRAY CONTAINING ERRORS INDUCED ON CENTER AND 
х SATELLITE ARRAYS (FIRST ELEMENT) IN THE X,Y,Z (SECOND 
х ELEMENT, 1-3) AND THE XTILT,YTILT,ZROT (4-6) 
* OUTPUTS: 
х CPH,XPH,YPH,ZPH : GLOBAL POSITIONS OF THE C,X,Y,Z HYDROPHONES FOR 
х CENTER AND SATELLITE SENSORS (FIRST ELEMENT 1-7) 
* PU,AU : CURRENT DATA FOR THE CENTER SENSOR PU-POSITION, AU- 
х ANGULAR ORIENTATION 
Х == = = <= <> = == == == > == = = == = = = = = ень» еш» «шо ср тат «шә «ше «шы «ше сь а == шив гар... о. гара өш» еш» еш» сш» еш» еш» ень «шы еш» ЯНЬ сн? сн? сш? “н? анэ аш? сн? аш” чив «шэ «шэ «шо «но "ЫР «=> 
DIMENSION CPH(7,3),SHIFT(7,6),X(3),A(3), ERROR(7,6), 
& ХРН(7,3),ҮРН(7,3),2РН(7,3),РО( (200806 
Е СР(3),ХР(3),ҮР(3),2Р(3),5ЕМ58(7) 
DOUBLE PRECISION CPH,XPH,YPH,ZPH,X,A,AU,PU,SHIFT, 
E XP,YP,ZP,CP,ERROR 
INTEGER  SENSR,I,ERR,EXT,DVP 
СНАВАСТЕК 15 МАМЕ1 
* 
C UPDATE POSITIONS OF C PHONES FROM PREVIOUS SHIFTS 
* 
1-0 
5 IF(SENSR(I+1).NE.0) THEN 
I=I+1 


CALL ARRAY(SENSR(I),X(1),X(2),X(3),A(1),A(2),A(3), ERR) 


X(1) » X(1) * ERROR(I,1) + SHIFT(I,1) 
Х(2) = X(2) + BRROR(1,2) + $НТЕТ(1,2) 
Х(3) = X(3) + ERROR(I,3) + SHIFT(I,3) 
А(1) з А(1) * ERROR(I,4) + SHIFT(I,4) 
A(2) » A(2) * ERROR(I,5) + SHIFT(I,5) 
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10 


7 


A(3) = A(3) + ERROR(I,6) + SHIFT(I,6) 
IF(I.EQ.1) THEN 
DO 10 N =1,3 


PU(N) = X(N) 
AU(N) = A(N) 
CONTINUE 
ENDIF 
CALL GLOBE(X,A,XP,YP,ZP,CP) 
DO 7 LP=1,3 
CPH(I,LP) = CP(LP) 
XPH(I,LP) = XP(LP) 
YPH(I,LP) = YP(LP) 
ZPH(I,LP) = ZP(LP) 
CONTINUE 
IF(I.LE.6)GOTO 5 
ENDIF 


ТЕ(БНТЕТ( 1,3) С 220 .AND. EXT.NE.2) THEN 
ЕХТ = 1 
CALL VELPRO(0,NAME1,DVP,EXT,PU(3) ) 
ENDIF 


RETURN 
END 


ЭЭ 
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SUBROUTINE FIND(AR,K,MI,MA) 
* FIND THE MINIMUM AND MAXIMUM OF THE ARRAY AR OF SIZE K 
J.A. GEMBARSKI 
NPS 01/01/92 


DIMENSION AR(K) 
DOUBLE PRECISION АВ,МІ,МА 
INTEGER K,I 


МІ з АВ(1) 
МА с 
DO 10 І-2,К 
IF(AR(I).GT.MA) MA 
IF(AR(I).LT.MI) MI 
10 CONTINUE 
RETURN 
END 


ў ж ж ж ж ok ў Жо хо к бо жо жох хох хо жо жо ж жох Ж ў ў ў Ж Ж Ў ў Ж ж Ж Ў Ж Ж Ж Ж Ў Ж Ж Ж Ў Ж Ў Ж Ж Ж Ж Ж Ж Ж Ж ж к б Жо ж Хо ж к Ў Ж Ж Ж ў ў Ў Ж ж 


SUBROUTINE PLANE(X,Y,CO,A,B,C,E) 


ии 
— 
+ 
~ 


THIS SUBROUTINE FINDS THE EQUATION OF A PLANE, 

PASSING THROUGH THE THREE POINTS X,Y,CO 
J.A. GEMBARSKI 
NPS 01/01/92 


ит» «ит» «ши» «ии» «ин» «ин» «ин» «ин» «ин» «но «а «ин» «ии» «но ту х х“" ФИШ» «р чна” ёта” і” іэ” «а х «у х «у х х" у" у" «_х х у" «к_ х х х х х х ју х ју х х х аа» өн» өн» «на» «на? «на» к» өк» өк» өк» “ј тј тј вэ 


DIMENSION X(3),Y(3),C0(3) 
DOUBLE PRECISION X,Y,CO,A,B,C,E 


ж ж » 


А = Х(2) % (Ү(3) - С0(3)) 
& О) оца 
5 + (Ү(2) * СО(3) - Ү(3) * СО(2)) 

в = ауаға Scu M 
к * X(3) * (Y(1) - CO(1)) 

& = (Ү(1) < 603) = Уз) сот) 

C= Xil х a= Come 
5 - X(2) * (Y(1) - CO(1)) 

& + (Ү(1) * СО(2у - У 62) * соту) 

E- -X(ly *.(Y(2) * 6003) ЕТЕ 9, 
& + X(2) * (Y(1) * GO(3) ҮҮ аме еа 
& = X(3) * (Y(1) * CO(2) =- УС) ЕСО 

RETURN 

END 
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QO0O000000009000000000000000 


SUBROUTINE RAWEITI(AI,A2,;,PI,P2,M,VEL,LM,DZ,VO,V1,TO,THO, 
+ DESC TEST) 
09/12/89 
NEW SUBROUTINE TO REPLACE TGEN, RAYTRACING ALGORITHM. 


NO CHANGES HAVE BEEN MADE TO THIS SUBROUTINE.  RECIEVED FROM 
LIB12.FOR OF REF 1 

J.A. GEMBARSKI 

NPS 01/01/92 


Хх к к к К ж кож к К К КК К к Ж К К Ж К К К К К Ж К К КК К к К Ж Ж К К К К К Ж К К К К К Ж К К К Ж К Ж К Ж К К К К К К Ж Ж Ж Ў Ж Ж Ж Ж Ж 


INPUTS: 

A1,A2 - POSITION OF SENSOR (A2 » O DOWN) 

Pl,P2 - POSITION OF SOUND SOURCE ( P2 » О DOWN ) 

LM - ARRAY CONTAINING LAYER MIDPOINTS 

M - NUMBER OF LAYER MIDPOINTS 

VEL - ARRAY CONTAINING SOUND VELOCITY AT THE 

LAYER MIDPOINTS. 

VO - SPEED INTERCEPT VALUES 

M - SPEED SLOPE VALUES 

DZ - DEPTH INCREMENTS 

IEST - FLAG FOR INITIALIZING THE ANGLE 
OUTPUTS: 

TO - TRANSIT TIME 

THO - ELEVATION ANGLE AT THE SENSOR 

ТНУ - ELEVATION ANGLE AT THE SOUND SOURCE 


Ж ХУ ж б ж ў ў ж ў Хо к ў ж ж кок ож Ж ж ож oe Ў ў ж Ж eoe oe cec ce ce ooo oe ce octo oe oe cote ccc oe o Ж К oe o e o x kx Xx ox 


DOUBLE PRECISION VEL(300),D2(300),LM(300),V0(300) 
DOUBLE PRECISION V1(300),ANG(300) 

DOUBLE PRECISION Al,A2,P1,P2,T0,THO,TH1,EP,S,C 
DOUBLE PRECISION H,HO,DW,VA2,VP2,R,Z,RV,Q1,Q2 
INTEGER M,IS,I,IEST,J,N 


ЕР = 1р-6 

DETERMINE LAYERS INVOLVED IN RAY FITTING 
ММ 
J 2M 


DO 30 I=1,M - 1 
IF ((LM(I).LE.A2).AND. (LM(I*1).GT.A2) 
IF ((LM(I).LE.P2).AND. (LM(I*1).GT.P2) 
30 CONTINUE 


) N=I 
) 2-1 


MAKE END CORRECTIONS FOR THE LAYERS 
DZ(N) = A2 - LM(N) 
DZ(J) = LM(J+1) - P2 


COMPUTE SPEED OF SOUND AT A2 AND P2 
VA2 = VO(N) + V1(N)*A2 
VP2 = VO(J}) + V1(J)*P2 
IF(IEST.NE.O) GOTO 50 


INITIALIZE THE ELEVATION ANGLE AT THE SENSOR, THO, BY 
FITTING A STRAIGHT LINE SPEED PROFILE BETWEEN P2 AND A2. 
IF(VEL(N).EQ.VEL(J)) THEN 
THO з РАТАМ((А2-Р2)/(Р1-А1)) 


ELSE 
Q2 - (VEL(N)*LM(J) - VEL(J)*LM(N)) / (VEL(N)-VEL(J)) 
01 - 0.5*(P1*A1)*(0.5*(P2-A2)*(P2*4A2-2*Q2) ) / (P1-A1) 


THO = РАТАМ((01-А1)/(02-А2)) 
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ENDIF 


С OUTER LOOP: SET UP RAY FITTING FOR THO = ELEVATION ANGLE 


50 S = DSIN(THO) 
C = DSQRT(1.0 - S**2) 
І з М 
ВУ = С/МА2 
HO = Al 
2 = А2 


60 ТЕ(М1 (1) ЕО TREN 
DW = DZ(I)/S 
Н = НО + DW*C 
ELSE 
Q2 з -УО(І)/У1(І) 
ТЕ (02) 61762763 


51 IS - -1 
сото 64 
62 таи - 0 
сото 64 
63 524-271 
64 CONTINUE 


Ql = НО * (Q2-2)*S/C 


В = О$ОВТ( (02-2)**2 + (Q1-HO)**2) 
C = RV*VEL(T) 
S - DSQRT(1.0-C**2) 
Н: 01 - IS*R*S 

ENDIF 


ЇЕ (ТЕО с COTO во 


НО + Н 
2 = ЪМ(Т) 
I=I-1 
сото 60 


80 ТН1 = DACOS(RV*VP2) 


C FRACTIONAL LAYER CORRECTION 
ТЕ(У1(Ј).МЕ.0.0) Н = 01 - IS*R*DSIN(TH1) 
IF (ABS(H-Pl).LT.EP) GOTO 90 


C | RE-ESTIMATE THO 
THO s DATAN(DTAN(THO)*H/P1) 
GOTO 50 


C PREPARE FOR COMPUTATION OF TRANSIT TIME. 
C COLLECT EXIT AND ENTRANCE ANGLES. 
90 ANG(J) + ТН1 


ANG(N+1) = THO 
C G(J) - 1/У1(7) 
C G(N+1) = -1.0/V1(N) 


DO 95 I = J+1,N 
ANG(I) = DACOS(RV*VEL(I)) 
С а= СУТ БЕ 
95 СОМТІМОЕ 


C | COMPUTE TRANSIT TIME 
TO = 0.0D0 
DO 100 I = J,N 
IF(V1(I).EQ.0.0) THEN 
TO = TO * DZ(I)/(VO(I)*DSIN(ANG(I))) 
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ELSE 
TO=TO + DLOG( (DCOS(ANG(I+1))*(1.0+DSIN(ANG(I))))/ 
* ((1.0+DSIN(ANG(I+1)))*DCOS(ANG(I))))/V1(T) 
ENDIF 
100 CONTINUE 


C REMOVE THE END CORRECTIONS. 


DZ(J) = LM(J+1) - LM(J) 
DZ(N) = LM(N+1) - LM(N) 
IEST = 1 

RETURN 

END 
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SUBROUTINE ISOGAD1(A1,A2,TO,THO,N,LM, VEL, VO, V1,DZ,H, Z, TH1) 
NO CHANGES HAVE BEEN MADE TO THIS SUBROUTINE.  RECIEVED FROM 
LIB12.FOR OF REF 1 (ORIGINAL NAME: ISOGRAD1) 
J.A. GEMBARSKI 
NPS 01/01/92 
09/25/89 
TO : TRANSIT TIME (SEC). 
THO : ELEVATION ANGLE AT SENSOR (RAD). 
: HORIZONTAL COORDINATE OF SENSOR. 
A2 : VERTICAL COORDINATE OF SENSOR, POSITIVE DOWN. 
VO,V1 : ARRAYS CONTAINING SOUND VELOCITY PARAMETERS. 
LM : ARRAY CONTAINING LAYER MIDPOINTS. 
N : INDEX OF DEEPEST LAYER USED. 


Q000000000000000 


oce ooo ox oe ooo Ж ХХХ Хх ў ў ў й Ж К й б хоў ў ў ў ХО Хо Хо ў ох ў й б й хо б Ў К Ў ў К ў ў Ў ў ў й ж Ж Ў Ў Ў Ў Ў Ў Ў Ў 


DIMENSION LM(300),V0(300),V1(300),DZ(300), VEL(300) 
DOUBLE PRECISION TO,H,H0,2,A1,A2,THO,TH1,VEL 
DOUBLE PRECISION LM,VO,V1,DZ,Q1,Q2 

DOUBLE PRECISION VA2,R,TH,RV,DW,DT,X,T 

INTEGER N,IS,I 


І е М 

Т = O.ODO 
TH=THO 

HO = Al 


VA2-VO(I)*V1(I)*A2 

RV=DCOS (TH) /VA2 

Z = A2 

DZ(N) = Z - LM(N) 

50 IF(V1(I).EQ.0.0) THEN 

DW - DZ(I)/DSIN(TH) 
DT = DW/VO(I) 
H = HO + DW*DCOS(TH) 
TH1 = TH 

ELSE 
Q2=-v0(I)/V1(I) 
IF (Q2) 51,52,53 


D 12725251 
СОТО 54 
52 IS - 0 
сото 54 
509 15 = 1 
54 CONTINUE 


Q1=HO + (Q2-Z)*DTAN(TH) 
R=DSQRT((Q2-Z)**2 + (Q1-HO) **2) 
TH1-2DACOS(RV*VEL(I)) 
DT=DLOG ( (DCOS(TH) /(1.0+DSIN(TH)))*((1.0+DSIN(TH1) ) / 
* DCOS(TH1)))/V1(TI) 
Н=01 - IS*R*DSIN(TH1) 
ENDIF 
T=T+DT 
ТЕ (1 св то) COTO 60 
Z-LM(I) 
HO = H 
TH=TH1 
1=1-1 
сото 50 
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E 


60 


DT=TO+DT-T 
IF(V1(I).EQ.0.0) THEN 
DW = VO(I)*DT 


DZ(I) = DW*DSIN(TH1) 
H = HO + DW*DCOS(TH1) 
7 «7 - DZ(I) 

ELSE 


X- (EXP(DT*V1(I)))*(1*DSIN(TH) ) /DCOS(TH) 
THl1sDACOS((2*X)/(1*X**2)) 
H = 01 - IS*R*DSIN(TH1) 
2 - 02 - IS*R*DCOS(TH1) 
ENDIF 


RESTORE THE END LAYERS. 


DZ(I) » LM(I*1) - LM(I) 
DZ(N) = LM(N+1) - LM(N) 
RETURN 

END 
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* 


C 
C 
C 
C 


О 
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SUBROUTINE ARRAY (AR,A1,A2,A3,XTILT,YTILT,ZROT, ERR) 
THIS SUBROUTINE PROVIDES RANGE COORDINATES OF THE ACOUSTIC 
CENTERS OF THE NANOOSE ARRAYS 

J.A. GEMBARSKI 

NPS 01/01/92 


REAL*8 Al,A2,AS,XTILT,YTILT,ZROT 
INTEGER*4 AR,ERR 


ARRAY O 
IF(AR.EQ.0) THEN 
Al = 12188.01D0 
А2 - -131.52D0 
A3 = 1295.33D0 
XTILT = 0.002909 
YTILT = 0.014835 
ZROT = -0.208183 
ARRAY 1 


ЕЪЗЕТЕ | БЕ ЕО 0 ТНЕШ 
А1 - 19463.16D0 


А2 - -174.9900 

A3 = 1308. 7600 

ATILT = 04061523 

ҮТТЫТ = 20.036070 

КӨШ = 212352579 
ARRAY 2 


ELSEIF(AR.EQ.2) THEN 


Al = 26991.39D0 
A2 = -109.83D0 
A3 = 1323.35D0 
XTILT = 0.000145 
YTILT = 0.005236 
ZROT = 2.670336 
ARRAY 3 
ELSEIF(AR.EQ.3) THEN 
Al = 34505.1000 
A2 - -80.76D0 
A3 = 1323.32D0 
XTILT = 10.027925 
YTILT - -0.011345 
ZROT = 2.928139 
ARRAY 4 
ELSEIF(AR.EQ.4) THEN 
Al = 42005.19D0 
A2 = -55.17D0 
A3 = 1318.28D0 
XTILT = 0.001164 
YTILT = -0.040288 
ZROT = -2.315877 
ARRAY 5 
ELSEIF(AR.EQ.5) THEN 
Al = 49497.00D0 
А2 = -25.23D0 
A3 = 1315.58D0 
XTILT = -0.000291 
УТТЬТ = -0.004027 
ZROT = 1.668535 
ARRAY 6 
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ELSEIF(AR.EQ.6) THEN 


Al = 56972.28D0 
A2 = -21.21D0 

A3 - 1308.50D0 
XTILT » 0.013817 
УТТЬТ = 0.041161 
ZROT = -0.703420 


ELSEIF(AR.EQ.7) THEN 
Al = 64680.66D0 

А2 = 15.3300 

АЗ - 1353.3900 
0.034907 

0: 922835 
-0.574144 


на 
3 
kA 
p 
У 
ни tl 


ARRAY 8 


ELSEIF(AR.EQ.8) THEN 
Al - 71969.73D0 


Az = -29.28D0 

A3 - 1300.89D0 

XTILT = -0.005963 

ет S =0. 012217 

ВО =e toe 7541 
ARRAY 9 

ELSEIF(AR.EQ.9) THEN 

Al = 570000 

А2 = з 20050 

A3 - 1290DO 

дърт -- 0.000000 

ШІБІ = 0.006000 

ZROT = 0.000000 
ARRAY 10 

ELSEIF(AR.EQ.10) THEN 

А1 = 47100.00р0 

А2 = -3600.0000 

A3 = 1300.00D0 

XTILT - 0.000000 

YTILT - 0.000000 

ZROT = 0.000000 
ARRAY 11 

EDSEIF(AR.EQ.11) THEN 

Al = 23173.89D0 

А2 = -6488.40р0 

АЗ = 1312.09р0О 

XTILT - -0.004654 

YTIIT = 0.000436 

ZROT = 2.784376 
ARRAY 12 


ELSEIF(AR.EQ.12) THEN 
А1 = 30731.25р0 


A2 - -6553.05D0 

АЗ = 1312.9000 

XTILT - 0.002036 

YTILT - 0.001745 

ZROT = -3.042179 
ARRAY 13 

ELSEIF(AR.EQ.13) THEN 

Al - 38213.61D0 

A2 - -6640.77D0 

АЗ = 1323.0500 


ZTILT = 0.000291 


107 


ТСТ = 209005294 
КОТЕ Е 153273522 
АККАҮ 14 


ELSEIF(AR.EQ.14) THEN 
Al - 45647.07D0 
-6513.18D0 
1324.78D0 
0.001309 
0.002327 
-2.348044 


D 
N 
П І 


на 
ІЗ 
+ 
с 
+3 
кооп 


АККАУ 15 


ELSEIF(AR.EQ.15) THEN 
А1 53249.4300 

А2 -6354.6000 

A3 1316-6650 

ZEIT 0.003345 
АЕ 0.004509 
ZROT 0.581544 


ARRAY 16 


ELSEIF(AR.EQ.16) THEN 
- 60859.74D0 
A2 2 95356.07D0 
= 1313.4200 
0.014835 
0.036943 
2.309276 


- 

+3 

н 

E! 

Ej 
"uw I 


ЕББЕЈЕ(АВ:ЕО. 17) THEN 
А1 - 58217.9300 

AZ = =6524. 1050 

A3 = 1313.43D0 
0.008290 
0.034761 
2.158449 


- 
+3 
H 
p 
н 
| но и 


ELSEIF(AR.EQ.54) THEN 
Al - 38029.95D0 

А2 = 5401.98р0 

АЗ = 51212. 6900 

Хати 0.007709 
-0.003782 
-1.056919 


- 
3 
H 
гэ 
rj 
uH ww M 


ELSEIF(AR.EQ.55) THEN 
Al = 45645.75D0 

A2 = 6369.66D0 

A3 = 1188.12D0 

XQ TET 0.027634 
ҮТГОТ 0.039415 
ZROT -0.728553 


ARRAY 56 


EDSEIF(AR.EO.55) THEN 
Al = 531801300 

А2 = 6417.96р0 

АЗ = 1218.8400 
90.037525 
0.048142 

и 


< 

3 

H 

p? 

+3 
bow М 


ELSEIF(AR.EQ.57) THEN 
Al - 60745.71D0 
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A2 = 6419.40D0 

A3 = 1088.24D0 

XTILT = 0.006981 

YTILT =O 001891 

ZROT = -3.108606 
ARRAY 23 


ELSEIF(AR.EQ.23) THEN 
Al = 41605.14D0 

A2 =-12150.18D0 

A3 = 1268.23D0 


XTILT = -0.002182 

YTILCT = 0.003200 

ZROT = -1.845214 
ARRAY 24 


ELSEIF(AR.EQ.24) THEN 
Al = 49572.00D0 

A2 =-12966.00D0 

A3 = 1300.00D0 


TIECT 00007202 

Yrlere—) 0.055269 

ZROT = -1.343904 
ARRAY 25 


ELSEIF(AR.EQ.25) THEN 
А1 - 56993.7900 

А2 --12999.33р0 

АЗ - 1205.48р0 


XTILT = 0.000291 

YTILT = -0.002182 

ZROTIE-S 07593726 
ARRAY 26 


ELSEIF(AR.EQ.26) THEN 
Al = 64442.94D0 
A2 =-12971.04D0 
A3 = 1255.35D0 


XTILI = =0.014835 

YTILI = =0.012654 

ZROT 52134192 
ARRAY 27 


ELSEIF(AR.EQ.27) THEN 
Al = 22119.60D0 


A2 =-15908.70D0 

АЗ + -83.0000 

XTILT - 0.000000 

YTILT = 0.000000 

ZROT = 0.000000 
ARRAY 28 


ELSEIF(AR.EQ.28) THEN 
А1 - 45000.00D0 


А2 =  1500.00р0 
A3 - 1350.00D0 
XTILT = 0.000000 
YTILT = 0.000000 
ZROT = 0.000000 
ARRAY 29 
ELSEIF(AR.EQ.29) THEN 
Al = 0.00ро 
А2 = 0.00DO 
A3 - 0.0000 
XTILT - 0.000000 
YTILT = 0.000000 
ZROT = 0.000000 
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Al - 0.000 

А2 = 0.000 

АЗ = 0.000 

XTILT = 0.000000 
YTILT = 0.000000 
ZROT = 0.000000 
ERR = 1 

ENDIF 

RETURN 

END 
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SUBROUTINE FINDOVR(I,REGION,ERR) 


* 
* SUBROUTINE TO FIND ALL CROSSOVER REGIONS FOR THE GIVEN ARRAY 
х ОМ ТНЕ МАМОО5Е БАМСЕ. 
* J.A. GEMBARSKI 
* NPS 01/10/92 
Kee ew и» чи «ко «ко «ко «ко «ко шив = = «ко чт» что Чив «м» «ше «ше еш» «ше SED = Чив ew ew = Чив = Чив Чив = = = = == = == = <= == == <= <= == == == == == == == == == == == == == <= == == == == == == == = «и» 
DIMENSION ВЕСТОН (6) 
INTEGER*4 I,REGION,ERR,K 
* 
DO 10 K -1,6 
ВЕСТОМ(К) = 0 
10 CONTINUE 
ERR з 0 
* 
C ARRAY 1 
IF(I .EQ. 1 )THEN 
REGION(1) = 1 
с ARRAY 2 
ELSEIF(I .EQ. 2 )THEN 
REGION(1) + 1 
ВЕСІОМ(2) + 2 
КЕСТОМ(3) = 3 
С АВВАҮ 3 
ELSEIF(I .EQ. 3 )THEN 
REGION(1) = 3 
REGION(2) = 4 
REGION(3) = 5 
REGION(4) = 6 
C ARRAY 4 
ELSEIF(I .EQ. 4 )THEN 
ВЕСІОМ(1) з 5 
REGION(2) = 6 
REGION(3) = 7 
REGION(4) = 8 
REGION(5) = 9 
REGION(6) = 10 
с ARRAY 5 
ELSEIF(I .EQ. 5 )THEN 
REGION(1) - 8 
REGION(2) = 9 
REGION(3) = 14 
REGION(4) = 15 
REGION(S) = 16 
REGION(6) = 17 
C ARRAY 6 
ELSEIF(I .EQ. 6 )THEN 
КЕСТОМ(1) = 15 
ВЕСІОМ(2) з 16 
REGION(3) = 18 
REGION(4) = 19 
REGION(5) = 20 
REGION(6) = 21 
С ARRAY 7 
ELSEIF(I .EQ. 7 )THEN 
REGION(1) = 19 
REGION(2) = 20 
REGION(3) = 26 
REGION(4) = 27 
С АВВАҮ 8 


ДЕЈ 


ЕБЕТ .ЕО. 
REGION(1) = 
ARRAY 11 
ELSEIF(1 .EQ. 
REGION (1) 
REGION (2) 
ARRAY 12 
ELSEIF(I .EQ. 
REGION (1) 
REGION (2) 
REGION (3) 
ARRAY 13 
ELSEIF(I .EQ. 
REGION(1) 
REGION(2) 
REGION(3) 
REGION(4) 
ARRAY 14 
ELSEIF(I .EQ. 
REGION(1) 
REGION (2) 
REGION (3) 
REGION (4) 
REGION(5) 
REGION(6) 
ARRAY 15 
ELSEIF(I .EQ. 
REGION(1) 
REGION(2) 
ВЕСТОН (3) 
ВЕСТОН (4) 
REGION(5) 
REGION(6) 
ARRAY 16 
ELSEIF(I .EQ. 
REGION(1) 
REGION(2) 
REGION(3) 
REGION (4) 
REGION(5) 
REGION(6) 
ARRAY 17 
ELSEIF(I .EQ. 
REGION(1) 
REGION(2) 
REGION (3) 
ARRAY 23 
ELSEIF(I .EQ. 
REGION(1) 
REGION (2) 
ARRAY 24 
ELSEIF(I .EQ. 
REGION (1) 
REGION (2) 
REGION (3) 
ARRAY 25 
ELSEIF(I .EQ. 
REGION (1) 
REGION (2) 
REGION (3) 
ARRAY 26 


8 )THEN 
27 


11)THEN 
1 
2 


12) THEN 
2 
3 
4 


13)THEN 
4 

5 

10 

dol 


14) THEN 


17) THEN 
25 
26 
27 


23)ТНЕМ 
їл 
12 


24)ТНЕМ 
12 
13 
23 


25)THEN 
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ELSEIF(I 
REGION(1) 
ВЕСТОН (2) 

54 

ELSEIF(I 
REGION(1) 
REGION (2) 

55 

ELSEIF(I .EQ 
REGION(1) 
REGION(2) 
REGION (3) 

56 

ELSEIF(I 
REGION(1) 
REGION (2) 
REGION (3) 

57 

ELSEIF(I 
REGION(1) 
REGION(2) 


ARRAY 


ARRAY 


ARRAY 


ARRAY 


ELSE 
ERR 
ENDIF 
RETURN 
END 


.EQ. 


.EQ. 


.EQ. 


.EQ. 


= ] 


26)ТНЕМ 
24 
25 


54)ТНЕМ 
6 
7 


55)ТНЕМ 
7 

8 

17 


56)ТНЕМ 
16 
17 
18 


57) THEN 
18 
19 
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SUBROUTINE OVERLAP(J,AR,ERR) 


* 
* SUBROUTINE TO RETURN THE ARRAYS ASSOCIATED WITH THE INPUT 
х CROSSOVER REGION J FOR THE NANOOSE RANGE. 
x J.A. GEMBARSKI 
* NPS 01/01/92 
LER EL OLX X X ты» «м «но «ни «но «шл «шо “ни «н «ню чия әш» «шэ «шо ЧИН ти еше еше «но «но «ню «но «но ЕЕ а 
DIMENSION AR(3) 
INTEGER*4  ERR,J,AR 
* 
С REGION 1 
IF(J .EQ. 1 )THEN 
AR(1) » 1 
AR(2) = 2 
AR(3) = 11 
C REGION 2 
ELSEIF(J .EQ. 2 )THEN 
АВ) 2.2 
AR(2) = 11 
AR(3) = 12 
С ВЕСІОМ 3 
ELSEIF(J .EQ. 3 )THEN 
AR(l) = 2 
AR(2) = 3 
AR(3) = 12 
C REGION 4 
ELSEIF(J .EQ. 4 )THEN 
АВ(1) з 3 
АН = 12 
AR(3) з 13 
С ВЕСІОМ 5 
ELSEIF(J .EQ. 5 )THEN 
АВ(1) з 3 
АВ(2) = 4 
AR(3) = 13 
С REGION 6 
ELSEIF(J .EQ. 6 )THEN 
AR(1) = 3 
AR(2) = 4 
AR(3) = 54 
C REGION 7 
ELSEIF(J .EQ. 7 )THEN 
АВ ЕА 
АВ(2) = 54 
AR(3) = 55 
с REGION 8 
ELSEIF(J .EQ. 8 )THEN 
AR(1) з 4 
АВ(2) з 5 
АВ(3) + 55 
с REGION 9 
ELSEIF(J .EQ. 9 )THEN 
АВ(1) = 4 
АВ(2) = 5 
AR(3) = 14 
C REGION 10 
ELSEIF(J .EQ. 10)THEN 
AR(1) = 4 
AR(2) = 13 
AR(3) = 14 
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REGION 11 
ELSELE(J 
AR(1) 
AR(2) 
AR(3) 
REGION 12 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 13 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 14 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 15 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 16 
ELSEIF(J 
AR(1) 
AR(2) 
АВ (3) 
REGION 17 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 18 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 19 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 20 
ELSEIF(J 
AR(1) 
AR(2) 
AR (3) 
REGION 21 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 22 
ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 
REGION 23 


"n Ww I tou | "on i uU Ww I MH нии пин uU Ww и нии пин т. 


.EQ. 
13 
14 
23 


.EQ. 
14 


23 
24 


.EQ. 
14 


15 
24 


SEO 
6 
15 
16 


. EQ. 
T5 
16 
25 


11) THEN 


12) THEN 


13) THEN 


14) THEN 


15)THEN 


16)THEN 


17)THEN 


18)THEN 


19)THEN 


20) THEN 


21)THEN 


22)THEN 


ТЭРЭ 


ELSEIF(J .EQ. 23) ТНЕМ 


AR(1) 
AR(2) 
AR(3) 

REGION 24 

ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 

REGION 25 

ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 

REGION 26 

ELSEIF(J 
AR(1) 
AR(2) 
АВ(3) 

REGION 27 

ELSEIF(J 
AR(1) 
AR(2) 
AR(3) 

ELSE 
AR(1) 
AR(2) 
AR(3) 
ERR 

ENDIF 

RETURN 

END 


нии ШІСІ uw M un nu i uo wu и 


ооо 


15 
24 
25 


.EQ. 
16 


25 
26 


„ЕО. 
16 
17 
26 


24 ) ТНЕМ 


25) THEN 


26) THEN 


27) THEN 
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Жж х » » » + 


* 


* С) 
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SUBROUTINE POUNIST(J,XO,YO,Z20) 


SUBROUTINE TO FIND THE INITIAL STARTING POINT (THE CENTER OF A 
TRIPLE OVERLAP REGION) XO AND YO, FOR OVERLAP REGION J. 
THE INITIAL STARTING POINT IS AT DEPTH XO (400 FT) ARBITRARILY 
J.A. GEMBARSKI 
NPS 01/01/92 
DIMENSION X(3),Y(3),2(3),AR(3) 
REAL*8 X,Y,Z,X0,YO, Z0,NUM1,NUM2,DEN,A,B,C 
INTEGER*4 J,AR,ERR 


CALL OVERLAP (J,AR,ERR) 
DO 10 ти], 3 

CALL ARRAY(AR(I),X(I),Y(I),Z2(I),A,B,C,ERR) 
CONTINUE 
SET THE DEPTH OF THE STARTING POINT 
ZO - 400.0 
NUM1 


NUM2 
DEN 


сие ата у (у= 72=т(1)**2)/(Х(2)-Х(1)) 
ааа т тук ус) Ха) 
2%((Ү(1)-Ү(3))/(Х(3)-Х(1))-(Ү(1)-Ү(2))/(Х(2)-Х(1))) 


YO - (NUM1 - NUM2)/DEN 


ХО = NUM1/2 * YO*(Y(1)-Y(2))/(X(2)-X(1)) 
RETURN 
END 
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к хо хо хо хо хо хо хо хо хо Хх Ұ 0X X + 
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SUBROUTINE GLOBE(P,A,XP,YP,ZP,CP) 


THIS SUBROUTINE DETERMINES THE GLOBAL POSITIONS OF EACH HYDROPHONE 
OF THE IMPUTED ARRAY.  INPUT POSITION IS THAT OF THE ACOUSTIC 
CENTER. 

INPUTS 


P: POSITION ARRAY P(1) Р(2) P(3), X,Y,Z POSITIONS RESPECTIVELY 
A: ORIENTATION ARRAY A(1),A(2),A(3) XTILT,YTILT,ZROT RESPECT. 


DUTPUTS 
XP: POSITION OF THE X HYDROPHONE OF THE SENSOR X,Y,Z COORDINATES 


RESPECTIVELY 


ШЕР е THE Y, 2, АМО C HYDROPHONE POSITIONS 


J.A. GEMBARSKI 
NPS 01/01/92 


DIMENSION B(5,3),XP(3),YP(3),ZP(3),CP(3),P(3),A(3) 
INTEGER I 
DOUBLE PRECISION P,A,B,S1,5S2,53,C1,C2,C3,D,XP,YP, ZP,CP 


D=30.0D0 


FORM THE SINES AND COSINES OF ALL EULER ANGLES:ROLL,PITCH AND YAW 


S2=DSIN(A(1)) 
C2=DSQRT(1-S2**2) 
Во, Са 


т 


ж ж 


* * * С) С) С) 
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C1=DSQRT(1-S1**2) 
53--051М(А(3)) 
C3=DCOS(A(3)) 


FORM THE B TRANSITION MATRIX 


B(1,1)=C2*C3 

В(1,2)-С2%53 

В(1,3)-52 
В(2,1)--51%52%С3-С1%53 
B(2,2)=-S1*S2*S3+C1*C3 
В(2,3) =51*С2 
В(3,1)--С1%52%С3%51х53 
B(3,2)=-C1*S2*S3-S1*C3 

В(3,3) =С1 *С2 
DO 66 I-1,3 

B(4,I)20.0D0 

В(5,І)- 0.5%(В(І,1) + B(I,2) + B(I,3)) 
CONTINUE 
PRINT*,'BI';B(1,1)],B(1,2) BIS) 
PRINT*,'B2',B(2,1),B(2,2) 4B 12999 
PRINT*,'B3',B(3,1),B(3,2),B(3, 3) 


LOCATE THE X,Y,2,C HYDROPHONE LOCATIONS 


-Р(1) * (D)*(B(1,1)-B(5,1)) 
ХР(2)-Р(2) + (D)*(B(1,2)-B(5;2)) 
-P(3) * (D)*(B(5,3)-B(1,3)) 


YP(1)-P(1) * (D)*(B(2,1)-B(5,1)) 
YP(2)-P(2) * (D)*(B(2,2)-B(5,2)) 
YP(3)-P(3) * (D)*(B(5,3)-B(2,3)) 


2Р(1)-Р(1) + (D)*(B(3,1)-B(5,1)) 
2Р(2)-Р(2) * (D)*(B(3,2)-B(5,2)) 
ZP(3)-P(3) * (D)*(B(5,3)-B(3,3)) 


СР(1)=Р(1) * (D)*(B(4,1)-B(5,1)) 


CP(2)-P(2) * (D)*(B(4,2)-B(5,2)) 
СР(3)-Р(3) + (D)*(B(5,3)-B(4,3)) 
RETURN 
END 
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SUBROUTINE RERROR(AR,ERRAR,ERR) 
THIS SUBROUTINE PROVIDES RANGE INDUCED ERRORS TO SENSORS 
(DELX,DELY,DELZ,DXTILT,DYTILT,DZROT) FOR THE NANOOSE RANGE 
FOR INPUT INTO THE PROGRAM SIMSTRT 
J.A. GEMBARSKI 
NPS 01/01/92 


DIMENSION ERRAR(6) 

DOUBLE PRECISION ERRAR,VAL 
INTEGER AR,ERR,NO 
CHARACTER*1 RES 


ARRAY O 
IF(AR.EQ.0) THEN 
ЕВВАВ(1) = 0.000 
ЕВВАВ(2) = 0.000 
ERRAR(3) » 0.000 
ERRAR(4) » 0.000 
ERRAR(5) + 0.000 
ЕВВАВ(6) = 0.000 
ARRAY 1 
ELSEIF(AR.EQ.1) THEN 
ЕВВАВ(1) - 0.00 
ЕВВАВ(2) = 0.000 
ERRAR(3) » 0.000 
ЕВВАВ(4) = 0.000 
ЕВВАВ(5) = 0.000 
ЕВРАВ(6) = 0.000 
АВВАУ 2 
ELSEIF(AR.EQ.2) THEN 
ЕВВАВ(1) = 0.000 
ЕВКАВ(2) = 0.000 
ERRAR(3) = 0.000 
ЕВВАВ(4) = 0.000 
ERRAR(5) = 0.000 
ЕВВАВ(6) - 0.00 
ARRAY 3 
ELSEIF(AR.EQ.3) THEN 
ЕВВАВ(1) = 0.000 
ЕВВАВ(2) = 0.000 
ЕВВАВ(3) = 0.000 
ЕВВАВ(4) = 0.000 
ЕВВАК(5) = 0.000 
ЕВВАВ(6) = 0.000 
ARRAY 4 
ELSEIF(AR.EQ.4) THEN 
ERRAR(1) - 0.000 
ЕВВАВ(2) = 0.000 
ЕВКАК(3) = 0.000 
ЕВВАЕ(4) з 0.00 
ERRAR(5) + 0.000 
ЕВВАВ(6) - 0.0р0 
ARRAY 5 
ELSEIF(AR.EQ.5) THEN 
ERRAR(1) = 7.9D0 
ERRAR(2) =-6.2D0 
ERRAR(3) =-1.8D0 
ERRAR(4) = 0.007D0 
ERRAR(5) =-0.003D0 
ERRAR(6) = 0.001D0 
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Q 
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ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR (6) 

ARRAY 6 

ELSEIF(AR.E 
ERRAR(1) 
ERRAR (2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ ( 6) 
ЕВВАВ (1) 
ЕВВАВ (2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ERRAR (6) 

ARRAY 7 

ELSEIF(AR.E 
ERRAR(1) 
ERRAR(2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 

АВВАУ 8 


"_ ни пи и 


ни ни ng n n u u m Hg пи 


Hon wu uw dg dw" aO 


ELSEIF(AR.EQ. 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ERRAR (6) 
ARRAY 9 
ELSEIF (AR.EQ 
ERRAR(1) = 
ERRAR (2) 
ЕВВАВ (3) 
ERRAR(4) 
ERRAR(5) 
ERRAR (6) 
ARRAY 10 


2 
23 
> 
nou uw wow 


0.000 
0.000 
0.000 
0.000 
0.000 
0.000 


.6) ТНЕМ 
-5.0D0 


ододододододододод мч 
о 
о 
о 


.9) THEN 
0.0р0 

0.0DO 
0.0DO 
0.0DO 
0.000 
0.000 


O) THEN 


21 

0.0р0 
Ооо 
О. ОБО 
0:000 
80101218, 
09D 


1) THEN 


гай 

0.0DO 
0.020 
0- ODO 
0.000 
0.000 
0.000 
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Q 


QOO 0 0 0990) 


ооооооодо 


Q 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR (6) 


ARRAY 13 
ELSEIF (AR.E 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 


АВВАУ 14 
ELSEIF(AR.E 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR(6) 
ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR (4) 
ERRAR(5) 
ERRAR(6) 


ARRAY 15 
ELSEIF(AR.E 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR(6) 
ERRAR(1) 
ЕВВАВ (2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 


ARRAY 16 
ELSEIF(AR.EQ 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR (4) 
ERRAR(5) 
ERRAR(6) 


ARRAY 17 
ELSEIF(AR.E 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 


ARRAY 54 


ELSEIF(AR.EOQ 


uw ww wu Yo 


Uu ou w w w u m ww m Ww mw uoo 


"пп w w mu nm Ww wu ни мн нико 


2 О 0 О О О Ј ОЈ О 


"ни ни "xo 


ELSEIF(AR.EQ 


.12) THEN 
0.000 
0.00 
0. 050 
0. 050 
0. 050 
0.000 


.13) ТНЕМ 
0.0DO 
0.000 
0.0DO 
0.0DO 
0.0DO 
0.0DO 


4) THEN 
. ODO 
е ODO 


21 
0 
0 
О. 
0.000 
0 
0 
4 
-8 
5 


. ODO 
= О ОБ О 
-0.004DO 
92900890 


.15) ТНЕМ 
11.000 
28.0D0 
-2.0D0 

. 02500 

. 01000 

. O10DO 

. ODO 

. ODO 

. ODO 

. ODO 

. ODO 

. ODO 


.16) THEN 
02080 
0.0р0 
0.000 
0.000 
0.000 
0 050 


.17) THEN 


.54) THEN 
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Q 


сс а ОО 


ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR(6) 
ARRAY 55 
ELSEIF(AR.E 
ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ERRAR(5) 
ERRAR(6) 
ARRAY 56 
ELSEIF(AR.E 
ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ЕВВАВ(5) 
ЕВВАВ(6) 
АВВАҮ 57 


t to t g gw d oo 


bout t tw two 


(1) 

2 

ж 

> 
111111 1 


ELSEIF(AR.E 
ЕВВАВ(1) 
ЕВБАВ(2) 
ЕВВАВ(3) 
ERRAR(4) 
ERRAR (5) 
ERRAR(6) 
ERRAR(1) 
ERRAR(2) 
ERRAR(3) 
ERRAR(4) 
ЕВВАВ ( 5) 
ЕВВАВ (6) 

ARRAY 25 

ELSEIF(AR.EQ 
ERRAR(1) 
ERRAR (2) 
ERRAR (3) 
ERRAR (4) 
ERRAR (5) 
ERRAR(6) 

ARRAY 26 


рий wm mn m Hn n m "m "n dO 


» 


0 
0 
0 
0 
0 
0 


5 
0 
0 
О. 
0 
0 
0 
5 
0 
0 
0. 
0 
0 
0 
5 
0 
0 
0. 
0 
0 
O 


2 
0 
0. 
о 
0 
О 
О 


. ODO 
. ODO 
. ODO 
. ODO 
. ODO 
• 000 


5) ТНЕМ 
. ODO 
. ODO 
ODO 
. ODO 
.ODO 
. ODO 


6) THEN 
. ODO 
. ODO 
ODO 
.000 
.000 
„000 


7) THEN 
. 000 
„оро 
ODO 
„оро 
. 000 
„оро 


3) ТНЕЦ 
. ODO 


.24) THEN 
-0.5р0 
-1.000 


o3 
-0- 


0 
-0 
0 
О 
0 
9 
0 
0 


2 
0 
0 
О. 
0 
0 
0 


700 
O10DO 
«00500 
· 02000 
. ODO 
ODO 
. ODO 
. ODO 
. ODO 
• 000 


5) THEN 
„Оро 
. ODO 
ODO 
SODO 
20DO 
. ODO 
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ELSEIF(AR.EQ. 


ERRAR(1) 
ERRAR(2) 
ERRAR (3) 
ERRAR(4) 
ЕВВАВ (5) 
ERRAR(6) 


C ARRAY 27 


ELSEIF(AR.E 


ERRAR(1) 
ERRAR (2) 
ERRAR (3) 
ERRAR (4) 
ERRAR(5) 
ERRAR(6) 


C ARRAY 28 


ELSEIF(AR.E 


ERRAR(1) 
ERRAR (2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 


C ARRAY 29 


100 


ELSEIF(AR.EQ. 


ERRAR(1) 
ЕВВАВ (2) 
ЕВВАВ (3) 
ЕВВАВ (4) 
ЕВВАВ (5) 
ЕВВАВ (6) 
Е15Е 
ERRAR(1) 
ЕВВАВ(2) 
ЕВВАВ(3) 
ЕВВАВ(4) 
ЕВВАВ(5) 
ЕВВАВ(6) 
ERR = 1 
ENDIF 
RETURN 
FORMAT (A1) 
END 


uU HW m dw tt gw oO 


uU "n ot "n n "(Oo 


26) THEN 
0.0D0 
0.0ро 
0. 050 
0.020 
0.000 
0.020 


27) ТНЕМ 
0.020 
0.000 
0.0DO 
0. 000 
0. 050 
0.0D0 


28) THEN 
0.0р0 
0.0DO 
0.0DO 
0.0р0 
0.0DO 
0.0DO 


29) THEN 
0.0D0 
0-000 
0.0г0 
0.0D0 
0.0D0 
0.0D0 


0.000 
0.0100 
0. 000 
0. 000 
0. 000 
0. 000 
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APPENDIX F: COMPUTER PROGRAMS SHIFTER AND LONG(BASE) 
These FORTRAN programs are used to determin the SBL and LBL poslocs 
for the error correction methodology. 


SUBROUTINE SHIFTER(A2,XTILT,YTILT,ZROT,T,K,NEW,H2, THONE) 


Qo oe oe x e x e eoe oe eoe Ж Ж Ж хо e eoe eoe e eoe oe eoe ee o eoe eee ee ee ee e ee eee o e e Ж Ж Ж x Ж Ж Xx 


THIS PROGRAM IS A MODIFICATION OF ERRPROP (08/22/90) TO 
SHIFT THE POSLOC WHEN THE ARRAY IS MOVED. THE ORIGIN IS OVER THE C- 
HYDROPHONE AND THE PROPOSED SYSTEM IS APPLIED. A2 IS THE DEPTH OF 
THE GEOMETRIC CENTER OF THE ARRAY CUBE. THE ACOUSTIC CENTER IS 
THE C-HYDROPHONE. 
TRANSIT TIME ERROR. 
THIS IS FOR THE KTH POSLOC AS DEFINED FROM THE SOURCE PROGRAM 
(NEWERR OR SETUP) 
J.A. GEMBARSKI 
NPS 01/01/92 


Хх c Ж Хх ў Хо ў ж Хх хх хох хох Хх ХХ ХХ Хх Хх eoe oe eoe oe oe eoe oe її її» її її її) її її її її» Ж x Xx x x иж ж X x x 


INPUTS: 
A2: DEPTH OF THE CENTER OF THE ARRAY 
XTILT,YTILT,ZROT: ORIENTATION INFORMATION ABOUT THE 
SENSING ARRAY (RADIANS) 


D: LENGTH OF ARRAY EDGES. 

L: DEPTH OF LAYER BOUNDARIES. 

M: NUMBER OF RECORDS IN THE VELOCITY DEPTH PROFILE. 

VEL: AVERAGE SPEED OF SOUND IN THE LAYERS. 

K: POSLOC TO BE SHIFTED 

uq RAY TRANSIT TIMES FROM EACH HYDROPHONE Х,Ү,2,С 
OUTPUTS: 

NEW: LOCAL COORDINATES OF THE SHIFTED POSLOC 

H2: THE HORIZONTAL RANGE TO THE SHIFTED POSLOC 


THONE:THE 'TRUE' ELEVATION ANGLE TO THE SHIFTED POSLOC 


со ео оо оо о оао соогоо оса емо Оо 


Хх хх ох хох хх ох ў хох Ж хх хх к ххх Хх Хх Хх Хх хх к ў хох Хх ў хох хх Хх Ж б ж Хх б б Ж Хх Хо ХХ ў à x ў ў ў ў б ў й ў ж ж 


DIMENSION B(5,3),DZ(300),HD(5),L(300) 
DIMENSION LM(300),NEW(3) 

DIMENSION T(18,4) 

DIMENSION V0(300),V1(300),VEL(300),X0(3) 


COMMON /5ЕТ1/ L,VEL,VO,V1,DZ,LM,M 

DOUBLE PRECISION B,DZ,HD,L,LM,PH1 

DOUBLE PRECISION T,THONE,VO,V1 

DOUBLE PRECISION VEL, X0,NEW 

DOUBLE PRECISION A1,A2,A2M,C1,C2,C3,CAZ,CX,CXO,CY 
DOUBLE PRECISION CYO,CZ,CZO,D 

DOUBLE PRECISION PIE,S1,S2,S$3,SAZ 

DOUBLE PRECISION V,XTILT,YTILT,ZROT 


DOUBLE PRECISION H2,22,THE 
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QOO 


оо 


12 


SL 


37 


INTEGER K,J,M,N 


РТЕ = РАСО5(-1.0р0) 
р = 30.0D0 


FORM SINES AND COSINES OF ALL THE EULER ANGLES:ROLL,PITCH,YAW 


52 = DSIN(XTILT) 

C2 = DSQRT(1.0 - S2**2) 
51 є DSIN(YTILT) /C2 

С1 = DSORT(1.0 - 51%%2) 
53 з -DSIN(ZROT) 

C3 = DCOS(ZROT) 


IN THE COORDINATE SYSTEM HAVING CENTER AT THE C-HYDROPHONE 
AND POSITIVE-UPWARD, THE LOCATIONS OF THE FOUR HYDROPHONES 
(RELATIVE TO THE ARM LENGTH D) ARE DEVELOPED NEXT. 


В(1,1) » C2*C3 

В(1,2) + С2#53 

В(1,3) = $2 

B(2,1) » -S1*S2*C3 - C1*S3 
B(2,2) = -S1*S2*S3 + С18СЗ 
В(2,3) = $1*С2 

В(3,1) = -С1*$2*С3 + $1*53 
В(3,2} = -С1*$2*53 - 51“с3 
B(3,3) = с1#с2 


CIKE NOTATION WILL BE USED TO LOCATE THE C-HYDROPHONE AND THE 
ARRAY CENTER. 
ВО — 1,3 


BAD) = о. ово 

Б(5,7) + 0.5*(B(J,1) * B(J,2) * B(J,3)) 
CONTINUE 
А1 + 0.000 


DETERMINE THE DEPTHS OF THE FOUR HYDROPHONES AND THE ARRAY CENTER. 


HD(1) = A2 + D*(B(5,3) - B(1,3)) 
HD(2) = A2 + D*(B(5,3) - B(2,3)) 
HD(3) = A2 + D*(B(5,3) - B(3,3)) 
HD(4) = A2 + D*(B(5,3) - B(4,3)) 
HD(5) - A2 


FIND THE DEEPEST HYDROPHONE 
A2M + 0.00 
DO 51 021,4 
IF(HD(J).GT.A2M) A2M = HD(J) 


CONTINUE 
LOCATE THE WATER LAYER, N, CONTAINING THE ARRAY. 
М = М 
DO 37 J = 2,M 
IF((LM(J-1).LE.HD(4)).AND.(LM(J).GT.HD(4))) N = J-1 
CONTINUE 


IF(N.GE.M) THEN 
PRINT*,'C HYDROPHONE IS DEEPER THAN CURRENT DEPTH-VELOCITY' 
PRINT*,'PROFILE. PROGRAM TERMINATED IN SHIFT SUBROUTINE' 
PRINT*,'POSLOC NUMBER',K 
STOP 

ENDIF 
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V = VO(N) + V1(N)*HD(4) 


CALCULATE THE PRE-TILT CORRECTED APPARENT POSITION 


40 


WRITE (44,221)K 

DO 40 J = 1,3 
XO(J)=(D**2 + (V*T(K,4)-V*T(K,J))*(V*T(K,4)+V*T(K,J)))/(2*D) 
WRITE (44,222) J,X0(J) 

CONTINUE 


COMPUTE DIRECTION COSINES . 


CXO = X0(1)/(V*T(K,4)) 

CYO = X0(2)/(V*T(K,4)) 

CZO - DSQRT(1.0 - CXO**2 - CYO**2) 
WRITE(44,223)CXO,CYO,CZO 


PERFORM EXACT TILT CORRECTIONS AND THE ROTATIONAL ALIGNMENT. 


42 


49 


CX = B(1,1)*CXO + B(2,1)*CYO + B(3,1)*CZO 
CY = B(1,2)*CxO + B(2,2)*CYO + B(3,2)*CZO 
CZ = B(1,3)*CxO + B(2,3)*CYO + B(3,3)*CZO 


WRITE (44,224)CX,CY,CZ 

SAZ = CY/DSQRT(CX**2 + CY**2) 
СА? - CX/DSORT(OXM*2 + СҮ**2) 
WRITE(44,225)SAZ,CAZ 

PH1 = DATAN2(SAZ,CAZ) 

THONE = 0.5*PIE - DACOS(CZ) 
WRITE(44,226)PH1,THONE 


CALL ISOGAD1(Al1,HD(4),T(K,4), THONE, N, LM, VEL, VO, V1,DZ,H2, 


22,ТНЕ) 
NEW(1) = H2*CAZ 
NEW(2) = H2*SAZ 
МЕМ(3) = 22 
RETURN 


FORMAT(5X,'POSLOC NUMBER  ',I2/) 


ҒОВМАТ(10Х,"Х0",11,Ғ11.4) 

РОВМАТ(/10Х,'ЄХО ',F11.4," CYO Fl ООО 
ЕОВМАТ(10Х,'Єх  ',F11.4,' су ва. сло шј) 
FORMAT(/10X, SAZ ",Е11.4," ёММН 9) 
FORMAT(/10X,'FM SHIFT PH ',F11.4,' TH ',F11.4) 

END 
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к к к ў к й ў й й ў кў й к к ко к хо к хох к хох Хх ў ж ох ў Хо хо Хх хо ў ж жо к хоў к кок к к ў ко к к Хх к к к к К к к ў x ў хо ў хо ж К ў Xo ў ў ў Ж 


SUBROUTINE LONG( TIME, LINKS, SENSR,CPH,K,XS, HD, THONE, TH, PHS, PHL,HO, 


12/19790 
LONGBASE.FOR IS A LONG BASE LINE METHOD FOR TRIPLE CROSSOVER REGIONS 
THIS IS A MODIFIED VERSION OF LONGBASE FROM REF 3. WHEN DETERMINING 
THE ARRAY TO UPDATE (DH) A TOLERANCE LIMIT WAS PLACED ON THE CLOSEST 
POSLOC DISTANCE SUCH THAT IF WITHIN EPS CHOOSE ARRAY 1 (INTERIOR) TO 
UPDATE. 
J.A. GEMBARSKI 
NPS Эа 
A1,A2,A3 are the location of the C-Hydrophones. 
Al(I) is the downrange location of the 3 arrays. 
A2(I) is the crossrange location of the 3 arrays. 
A3(I) is the depth location of the 3 arrays. 
( Depth is positive down orientation ). 
K IS THE OVERLAP REGION OF INTEREST 
THONE IS THE INITIAL ELEVATION ANGLES TO THE SBL POSLOCS 
HD IS THE HORIZONTAL DISTANCE TO THE SBL POSLOCS 
OUTPUTS 
ТН ELEVATION ANGLES TO THE LONGBASE POSLOCS 
PHS/PHL  AZIMUTHS TO THE SBL/LBL POSLOCS 
HO HORIZONTAL RANGE TO THE LBL POSLOCS 
XL LBL POSLOC COORDINATES 


ж ж Ў Ж ў ў ж ж К ў ў ў ж хо хо жох хо хо ж к хо ж хо ж хох ў хо жоў к ж Ж ў ў ж хох хо ж Ж Хх жоў ж ж Ж ж ж Ж Хо ж ж хо ж ж ж Хо ж ў Ж Жо ж ko X ok ok Ж ж 


xàQ30000009030090300300000000Ó020D 


DIMENSION A1(3),A2(3),A3(3),X(3),Y(3),2(3),THO(3), T(3) 
DIMENSION H(3),AR1(2),AR2(2),HD(18),PHO(3), PH1(3) 
DIMENSION XX(3),YY(3),AR(4),LM(300),D2(300),V1(300) 
DOMENSTONGDUOSSOS VEL(300),VO( 300) ,XL(6,3), THONE( 18) , HO( 18) 
DIMENSION PHS(18),PHL(18),TH(18),CPH(7,3),XS(18,3) 
DIMENSION LINKS(18),SENSR(7), TIME(18,4) 


COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 

DOUBLE PRECISION L,VEL,V0O,V1,DZ,LM,HO, PHS, PHL, TH 

DOUBLE PRECISION A1,A2,A3,X,Y,2,D20,THO,T,20,200,H 

DOUBLE PRECISION D12,D13,D23,AR1,AR2,D1,D2,D3,HD, PHO, PH1, XL 

DOUBLE PRECISION VA,VB,UA,UB,EPS,XX,YY,DS,DM,GAM, THONE, TIME, CPH, XS 


INTEGER DL1,DL2,DH,MARR,AR,ERR,K, LINKS, SENSR,1,M,N 


ЕР5 = 1р-3 
ERR = 0 
C GAM is a convergence tuning constant. 

САМ = 5.000 

N = (3%К)-3 

po 1071151,3 e 
Al(I) = CPH(LINKS(I+N),1) 
А2(1) = CPH(LINKS(I+N),2) 
АЗ(І) = CPH(LINKS(I+N),3) 
X(I) = XS(I+N,1) 
Y(I) = XS(I+N,2) 
2(1) = XS(I+N,3) 
H(I) = HD(I+N) 


THO(I) = THONE(I+N) 
T(I) = TIME(I+N,4) 


w27 


ООООООООО 


10 


AR(I) = SENSR(LINKS(I+N) ) 
CONTINUE 


Compute the max dz. 


70 


15 


80 


720 


90 


DZO  MAX(DABS(Z(1)-2(2)),DABS(Z(1)-2(3)),DABS(Z(2)-2Z2(3))) 


DO 70 I = 
PHO(I) 
CONTINUE 


1,3 
- DATAN2(Y(I)-A2(I),X(I)-A1(I)) 


WRITE(3,280)AR(1),AR(2),AR(3),AR(4) 
WRITE(3,250)A1(1),A2(1),A3(1) 
WRITE(3,251)A1(2),A2(2),A3(2) 
WRITE(3,252)A1(3),A2(3),A3(3) 
WRITE(3,220)X(Y) Ка (ШШ) 
ИЕТТЕ(3,271)Х(2|,Ү(212212) 
WRITE(3,272)X(3),Y(3),Z(3) 
WRITE(3,*)' ' 
WRITE(3,253)H(1),H(2),H(3) 


D12 » DSQRT((X(2)-A1(1))**2 * (Y(2)-A2(1))**2) 
D13 = DSQRT((X(3)-Al(1))**2 + (Y(3)-A2(1))**2) 
ТЕ ((D12.GE.H(1)).OR.(D13.GE.H(1))) THEN 

ZO = МАХ(2(1),2(2),2(3)) 
ELSE 

Z0 = МїМ(2(1),2(2),2(3)) 
ENDIF 
DO 75 I = 1,3 

IF(Z(I).EQ.Z0) MARR = I 

WRITE(3,254)DS,2Z0 


GOTO 720 

Dl = DSQRT((UA-A1l(DH))**2 + (VA-A2(DH))**2) 
D2 = DSQRT((UB-A1(DH))**2 + (VB-A2(DH) )**2) 
D3 = MIN(D1,D2) 


WRITE(3,287) D1,D2 


IF(DABS(H(DH) - D3).LT.EPS) GOTO 100 


200 + 20 

ВОН = DSQRT(H(DH)**2 * (A3(DH)-20)**2) 

ZO = ZOO + (A3(DH) - Z00)*(1 - H(DH)/D3)*GAM 
DS = D3 - H(DH) 


WRITE(3,254)DS,20 
WRITE(3,253)H(1),H(2),H(3) 
CONTINUE 
DO 90 I = 1,3 
IF (I.EQ.MARR) GOTO 90 
САЫ. МЕНІОС(0.0В0,АЗ(І),ТНО(Т)/ТІТУН (Ы 
CONTINUE 


IF(MARR.EQ.4) GOTO 98 


C Adjust POSLOCs for new horizontal ranges. 


ро 95 Г = 1,3 
IF(I.EQ.MARR) THEN 
XX(I) з ХАІ) 
YY(I) з У(І) 


ЭБ 


ELSE 


XX(I) = Al(I) + H(I)*DCOS(PHO(I)) 
YY(I) = A2(I) + H(I)*DSIN(PHO(I)) 
ENDIF 
CONTINUE 


C Find the two closest POSLOCs. 


C 
C 


98 


100 


D12 = DSQRT((XX(1) - XX(2))**2 * (YY(1) - YY(2))**2) 
013 = DSQRT((XX(1) - XX(3))**2 * (YY(1) - YY(3))**2) 
223 = DSQRT((XX(2) - XX(3))**2 * (YY(2) - YY(3))**2) 
DM = MIN(D12,D13,D23) 

WRITE (3,288)D12,D13,D23 

IF(DM.LT.EPS) DM = D23 

IF(DM.EQ.D23) THEN 


DLI = 2 

DL2 = 3 

DH = 1 
ELSEIF(DM.EQ.D13) THEN 

DL1 = 1 

DL2 = 3 

DH = 2 
ELSE 

DL1 = 1 

DL2 = 2 

DH = 3 
ENDIF 
WRITE(3,255)DH,GAM 
MARR = 4 
AR1(1) = A1(DL1) 
AR2(1) = A2(DL1) 
AR1(2) = Al(DL2) 
AR2(2) = A2(DL2) 


CALL CIRCSOLV(AR1,AR2,H(DL1),H(DL2),UA,VA, UB, VB) 
WRITE(3,285)UA,VA 

WRITE (3,286)UB,VB 

GOTO 80 


CONTINUE 


IF(D3.EQ.D2) THEN 


VA = VB 
UA = UB 
ENDIF 
WRITE (3,260)UA,VA, ZO 
КЕ. 1) = UA 
XL(K,2) = VA 
XL(K,3) = 20 
0 110 1- 1,3 
HO(I+N) = Н(1) 
PHO(I) » DATAN2(Y(I)-A2(I),X(I)-A1(I)) 
РН1(1) = РАТАМ21(УА-А2(1),0А-А1(1)) 


ТН(ІзМ) - ТНО(І) 

PHS(I*N) - РНО(І) 

PHL(I+N) = PH1(I) 

ЧВІТЕ (3,261)АВ(І),РНО(І),РНІ(І) 
ЧВІТЕ (3,262)ТНОМЕ(І-М), ТНО(І) 


110 CONTINUE 
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RETURN 


ЕОБМАТ ( /10Х, 'А1(1)=' ,210.2,' A2(1)=',F10.2,' A3(1)=',F10.2) 
FORMAT(10X,'A1(2)2',F10.2,'  A2(2)2',F10.2,'  A3(2)-',F10.2) 
FORMAT (10X,'A1(3)=',F10.2,'  A2(3)=',F10.2,'  A3(3)=',Fl0.2) 
FORMAT(10X,'H(1)5',F11.4,'  H(2)-',Fl1.4,'  H(3)s',F11.4) 
FORMAT(/10X,'DS =',F11.4,' 20 =',Е11.4) 
FORMAT(/10X,'DH = ',I2,' GAM = ',F4.1) 
FORMAT(//10X,'U | -',Е10.2,' “Ут ,.ЕО.2 О 

F10.2) 
FORMAT(/10X, ‘ARR #',12,' PHO = ',F10.6,' РНІ є ',F10.6) 
FORMAT(21X,'THOO 2 ',F10.6,' THO = ',F10.6) 
FORMAT(/10X,'X(1) s',F10.2,'  Y(1) s',P10.2,' 201) Edom 
FORMAT(10X,'X(2) s',Fl10.2,'  Y(2) =',Е10.2,' 22) = MEI 
FORMAT(10X,'X(3) s',F10.2,' Ү(3) =',F10.2,' 2(3) =',F10.2) 
FORMAT(10X,'ARRAYS ',I12,', ',I2,', and ',12,7X, CASH Meaney 
FORMAT(/10X,'UA - ',F10.2,' VA -',F10.2) 
FORMAT(10X,'UB = ',F10.2,' УВ =',Р10.2) 
FORMAT(/10X,'D1 - ',F11.4,' D2 = ',F11.4) 
FORMAT(/10X,'D12 = ',F11.6,' D13 = ',Fll.6,'  D23 = | ЕЙМ( 
ЕКО 


QC o eo o ox Я Я Ж ХХ к Я ў Я Ў Я Ж К ХХ Я Ж Ж Ж ў Ж к к Я ў Я Ж Ж Ж хоў Ж ў Я ў Я Ж Ж Ж Ж Я Ж ў Ж Хо к ў Ж Ж ў Ж К Ж ХХ Ж Ж Ж Ж 


SUBROUTINE NEWLOC(A1,A2,THO,T,HO0,2,20) 


THP:  ADJUSTED ELEVATION ANGLE 


C “те «ше о и «ше ње о зэм мз ч = +з зэв зэв ээж зэм ашы зэм ч» ш «ке еше «ме энэ эмэ «ме «ке «ше «ке «ме а о и эш чч» о и њи зэм = зэм «ше «ше == == == == == = == = <= = = == == = = = = = 
C 

COSTNBUPS: 

C A1: HORIZONTAL COORDINATE OF SENSOR 

С А2: VERTICAL COORDINATE OF SENSOR, POSITIVE DOWN 
C M: INDEX OF DEEPEST LAYER USED 

C THO: ELEVATION ANGLE 

C T: TRANSIT TIME 

C HO: HORIZONTAL RANGE 

C Z: DEPTH OF POSCOC 

C 20: DEPTH GOAL 

C 

C OUTPUTS: 

C 

C 

C 


ит» «ии» ФИШ: a сь сь сш” «ые се” «лы» «шы» с” са” са” се: а” са” са” с” са” тэ” а” са” «шы» т а” а” ee ша” аі т сі цці” цці” цці ЕР ЕР РБ ЕШЬ caede cade цц” сш” «шт ee 


DIMENSION L(300),VEL(300),V0(300),V1(300),D2(300),LM(300) 
COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 

DOUBLE PRECISION L,VEL,VO,V1,DZ,LM 

DOUBLE PRECISION THO,T,HO,2,20,THP,EPS,A1,A2,THl 

INTEGER J,M,N 


C compute the slant range 


10 


EPS = .0010D0 
DO 5 J = 2,M 
IF((LM(J-1).LE.A2).AND.(LM(J).GT.A2)) N = 2-1 
PRINT*,'N',N,'A2',A2, 'LMJ-1',LM(J-1), 'LMJ' , LM(J) 
CONTINUE 


THP - THO 

CONTINUE 

ТНР = ТНР - (20-2)/HO 

PRINT*,'N',N 

CALL ISOGAD1(Al1,A2,T, THP,N,LM, VEL, VO,V1, Dip Hem cameos) 
IF (DABS(Z-20).GE.EPS) GOTO 10 


THO = THP 


130 


RETURN 
END 


Qu а 


SUBROUTINE CIRCSOLV(A1,A2,H1,H2,U1,V1,U2,V2) 


C = æ ань = ч «що «ше Чи: «що чии «що чии чии чии чии чии чии «не өше еше еш» еме «ще «що «що «що «що «що «що еше еш» еше еме что чии «то чии чи чии чии чии чии чии чии чин «що чии «що «що «що «що «ще «що «що чии «що чин чин чи: чин «е чин чии чии «ға 
Ce INPUTS: 

C ДИН CENTER OF) THE 1ST CIRCLE 

cC A2: CENTER OF THE 2ND CIRCLE 

С H1,H2:  RADIUS 

5 ООТРОТ5: 

> ШІ, УШ: ЗТ INTERSECTION. POINT 

e U2,V2: 2ND INTERSECTION POINT 

© a. am an «но ве «не «ые «ые am an am ao an «не нэ «но ане «но «ша ем» еш» еш» еше «ше ше еш» ем» ем» «ша ем» «ше «не анэ ане анэ анэ анэ ане «ше ем» еше «не анэ анэ «не анэ анэ «н? «нэ анэ сне «нз ане «ее вые «ые «е ане «ии «ще «що «що «що «що «же = 


DIMENSION A1(2),A2(2) 
DOUBLE PRECISION Al,A2,B0,B1,Hl1,H2,U1,U2,V1l1,V2,P1l,P2,P3,B2 
INTEGER ERR 


ERR = 0 

ВО = Н1**2 - Н2##2 * A1(2)**2 - A1(1)**2 + A2(2)**2 - A2(1l)**2 
В1 = 2*(A1(2) - A1(1)) 

B2 = 2*(A2(2) - A2(1)) 

Bl = -B1/B2 

BO = ВО/В2 

Pl = 1+B1**2 

P2 - 2*B1*(B0-A2(1))-2*A1(1) 

РЗ = Al(1)**2 + (BO-A2(1))**2 - H1**2 


CRECLTOURAD(PI, P2, P3,U1,U2,ERR) 

IF (ERR.EQ.1) THEN 
WRITE(*,*)' THERE WAS AN ERROR IN QUAD SOLUTION' 
STOP 

ENDIF 

V1 = ВО + В1*01 

М2 — ВВ + BI*U2 

RETURN 

END 


QD C oo ooo oe oe oo ox ooo oe oe oe oe хох ж ж хох хох ох хох хох ох ж ж ж Хх Хх хох жох хох ох ох ж ж ж oe oe x oe o x ж ў Ж Ж 


SUBROUTINE QUAD(A,B,C,X1,X2,ERR) 
DOUBLEMPRECISION A,B,C,D,X1,X2 
INTEGER ERR 


О = B**2 - 4.0*A*C 
IF (D.LT.0.0DO) THEN 


ERR = 1 
GOTO 10 
ENDIF 


Xl = (-B + DSQRT(D 

X2 = (-B - DSORT(D 
10 RETURN 

END 


)/(2.0*A) 
)/(2.0*А) 


“Зөн” d 
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APPENDIX G: 


COMPUTER PROGRAM VELPRO 


The VELPRO program sets up the water column for use in RAYFIT and 


ISOGAD subroutines. 


It also performs any DVP extrapolation required if an 


array hydrophone should exceed the deepest depth of the current profile. 


The extrapolation control can be overridden from the calling program. 


SUBROUTINE VELPRO(OP,NAME1,N,EXT,A2) 


* 
х THIS A COMBINATION OF FORTRAN PROGRAMS VELMOD (2/22/90) AND 
х — ERRPROP (8/22/90) IN LIB12.FOR OF REF 1. 
* - А CORRECTION WAS MADE TO THE EXTRAPOLATION PROCEDURE FROM ERRPROP 
х IN THE TERM GG. THE FACTOR OF 21 WAS INADVERTENTLY LEFT OUT OF 
х THE DENOMINATOR IN THE ORIGINAL PROGRAM. 
* THIS SUBROUTINE READS IN THE DEPTH VELOCITY PROFILE AND THEN 
х PERFORMS A DEPTH EXTENSION IF A2 IS DEEPER THAN THE LAST LAYER 
х J.A. GEMBARSKI 
* NPS 01/01/92 
Ж на «и» «и» «и» = = = а а «нэ => == == с «нь а = == == == «НЬ = == «НЬ ЯНЬ «ме «ме «ме «ы» «шь «м» «е «м» «жз «м» «шы шы «шы «ша «шы «ше «шы «шь «шь еш» «ша «шь «шь «шы «шы «шы шь == = == == GU ат» == == == = => == == == == 
DIMENSION L(300),VEL(300),V0(300),V1(300),D2(300), LM(300) 
COMMON /SET1/ L,VEL,VO,V1,DZ,LM,M 
DOUBLE PRECISION 1., УЕ1.,,1.М,02,У0,У1,КО,С,СС,5У,5У02,5У0 5020 :0Ш8 
DOUBLE PRECISION U,LB,A2 
ІМТЕСЕВ EXT,M,OP,N 
CHARACTER*15 NAME1 
IF (EXT. £0.1) СОЛОН І. 
C READ IN THE DEPTH AND VELOCITY ARRAYS 
IF(N.EQ.l) NAMEl = '/ON880512 DVT A' 
IF(N.EQ.2) NAMEl = '/ON880622 DVT A' 
IF(N.EQ.3) МАМЕ1 = '/ON880721 DVT A’ 
IF(N.EQ.4) МАМЕ1 = '/ON880803 DVT А' 
IF(N.EQ.5) NAME1 = '/ON881027 DVT A’ 
IF(N.EQ.6) NAME1 = '/ON890113 DVT A’ 
IF(N.EQ.7) МАМЕ1 = '/ON890308 DVT A' 
IF(N.EQ.8) NAME1 = '/ON890322 DVT A’ 
IF(N.EQ.9) NAME1 = '/ON890426 DVT A' 
IF(N.EQ.10) NAME] = '/ONTESTO ОУТ А! 
IF(N.EQ.11) NAME1 = '/ONTEST2 DVT А! 
IF(N.EQ.12) NAMEl = '/ONTEST4 DVT A' 
ТЕ(М.ЕО.13) МАМЕ1 = '/ONTEST6 DVT A' 
IF(N.EQ.14) NAME] = '/ONTEST8 РУТ А! 
IF(N.EQ.15) NAME1 = '/ONTEST83 DVT A’ 
IF(OP.EQ.1)PRINT*, ‘LOAD VELOCITY FILE: ",МАМЕ1 
с IF(OP.EQ.1)WRITE(91,*)'LOAD VELOCITY FILE: ',NAME1 
IF(OP.EQ.1)WRITE(92,*)'LOAD VELOCITY FILE: ',МАМЕ1 


OPEN (UNIT=4, FILE=NAME1,STATUS='OLD' ) 


D 


CONTINUE 
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READ(4,130,ERR-27,END-10)L(I),VEL(I) 


L(I) = Вт) 
Т = 1+1 
сото 5 
7 WRITE(*,*)' ! THERE WAS AN ERROR READING THE FILE !' 
STOP 


10 CONTINUE 

CLOSE (UNIT=4) 

М = 1-1 

FORM THE SET OF LAYER MIDPOINTS 
DO 40 I-1,M-1 
LM(I) » .5*(L(I) * L(I*1)) 

40 CONTINUE 
* FORM DEPTH INCREMENTS, AND ALL SOUND VELOCITY SLOPES AND INTERCEPTS 


DO 50 Т=1,М-2 


DZ(I) = LM(I+1) - LM(I) 
VO(I) = (LM(I*1)*VEL(I) - LM(I)*VEL(I*1))/DZ(I) 
Vl(I) » (VEL(I*1) - VEL(I))/DZ(I) 
50 CONTINUE 
LM(M) = LM(M-1) * DZ(M-2) 


130 FORMAT(5X,D8.2,5X,D7.2) 
111 IF(A2.LT.LM(M-1) .OR. EXT.EQ.2) GOTO 126 
EXTRAPOLATE 


IHE SOUND VELOCITY PROFILE BY USING A QUADRATIC FUNCTION OVER 
THE DEEPEST 100 FEET. 


ооо 


C FIRST COUNT THE NUMBER OF LAYERS (OF THICKNESS DZ(M-2)) TO 
с BE ADJOINED. ALSO MUST EXTEND THE L ARRAY. 


KO = 2 * MAX(O,NINT((A2-LM(M-1)) /DZ(M-2))) 


C | FIND AVERAGE DEPTH OF LAST 100 FEET. 
ТВ = 0.020 
DO 43 I = M-21,M-1 
LB = LB + LM(I) 
43 CONTINUE 
LB = LB/21 


C FORM SUMS OF POWERS AND PRODUCTS. 
SV = 0.000 
SVU2 = 0.000 


SVU = 0.0р0 

502 - 0.0ро 

504 - O.0DO 

DO 45 I = M-21,M-1 
U = LM(I) - LB 


SV = SV * VEL(I) 
SVU = SVU + U*VEL(I) 
SVU2 = SVU2 + U**2 * VEL(I) 
SU2 = SU2 + U**2 
SU4 = SU4 + U**4 
45 CONTINUE 


С = SVU/SU2 
GG = (21*SVU2 - SU2*SV)/(21*SU4 - SU2**2) 


133 


V1(M-1) + с 


E PERFORM THE EXTRAPOLATION. 
DO 125 I=M,M+KO 


У1(1-1) = У1(1-2) з GG*DZ(M-2) 

LM(I) = LM(I-1) + 02(М-2) 

VEL(I) = VEL(I-1) + DZ(M-2)*V1(I-1) 

VO(I-1) » (LM(I)*VEL(I-1) - LM(I-1)*VEL(I))/DZ(M-2) 
L(I*1) = L(I) * DZ(M-2) 

DZ(I-1) = DZ(M-2) 


125 CONTINUE 
C UPDATE M, THE NUMBER OF LAYERS 
M = M + KO 
126 CONTINUE 


RETURN 
END 
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APPENDIX Н: REGIONAL POSLOC DATA (INTERIOR ARRAY 15) FOR RANGE CORRECTION 


REGIONAL POSLOC DATA INTERIOR ARRAY 15 
SATELLITE ARRAYS WITH ERRORS - ISOSPEED 


Я REGION 13 
ARRAY 15 SBL ARRAY 14 SBL ARRAY 24 SBL LONGBASE GOAL 
X 49520.90 49487.10 49482.90 49510.14 49493.30 
Y 28605720 звы 0203 - 85919006 = Sie а 20593779 
Z 425.14 375 98 424. 18 428.80 400.00 
THS 0.20431 0221783 Q7 2/957 
THL 0.20347 0520578 029951 
PHS з 2269788 -0750234 1:58702 
PHL 22.60237 -0.49611 1.58078 
HS 4364.28 4376.90 4367.09 
HL 4365.04 4388.25 4368.03 
REGION 14 
ARRAY 15 SBL ARRAY 5 SBL ARRAY 14 SBL LONGBASE GOAL 
X 49390.02 49412.46 49407.20 49401.91 49404.92 
X =4 369. 35 -4360.42 143570722 -4360.26 -4356.84 
Z 417.28 386.64 355.75 387-20 400.00 
THS 0.20704 0.21490 021855 
THL 2521897 0.21477 0221821 
PHS 2.66863 - 11859600 251579 
PHL 2706552 - 1153845 0.51840 
Н5 4342.51 4317.04 4318.03 
НТ, 4336.08 4317.16 4318.35 
REGION 15 
ARRAY 15 SBL ARRAY 5 SBL ARRAY 6 SBL LONGBASE GOAL 
X о Ото 53243752 53236. 15 53241.45 532995575 
X 2059.94 -209]9 T6 =2091773 =2069.93 22065769 
Z 389.46 408.91 411.46 343.39 400.00 
TES 0. 21580 01524217 0221216 
ШЕНІ, 0.220666 0.22861 2222820 
PHS 1.58433 = 0: 50286 -2006 55 
PHL 1.57415 =0.49851 -2.63544 
HS 4287.92 4250.41 4250.74 
HL 4277.56 4235.70 4235751 
REGION 21 
ARRAY 15 SBL ARRAY 6 SBL ARRAY 16 SBL LONGBASE GOAL 
X 57089 28 5052 13 57062.38 57073257 57054.98 
у 74266.55 =4325.19 20325959 =4319. 17 24330.68 
Z 370.65 412.73 409.32 385.99 400.00 
THS 0.21850 0720903 0.21008 
THL 0.21495 0.21524 0.21547 
PHS 05502685 = 1 54386 25552665 
PHL 0.48858 -1.54160 2265032 
HS 917297 4310.26 4330.69 
HL 4321.34 4304.50 41250465 
REGION 22 
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THS 
THL 
PHS 
PHL 


HL 


ARRAY 15 SBL 


57081.17 
-8523.61 
379.08 
0.21267 
0.20421 
-0251722 
-08:53262 
4401.01 
4408.89 


ARRAY 15 SBL 


53341.65 
- 10680456 
406.18 
0.20989 
0: 19921 
21.558099 
-1,551859 
4333.94 
4343.55 


ARRAY 16 SBL 


57057.44 
-8582.94 
394.12 
0.20893 
92209591 
-2.61546 
=2. 61520 
4426.93 
4431.59 


REGION 


ARRAY 24 SBL 


93286499 
- 10652781 
425.32 
0.20128 
0.19505 
0.54496 
0.54459 
4367.96 
4373.42 


ARRAY 25 SBL 
57056.64 
-8589.56 


23 


ARRAY 25 SBL 
53293.90 
-10704.16 
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404.19 

0.18296 
0.18021 
155218 
555202 
4416.72 
4418.96 


418.14 
0- 16299 
0: 17508 
2.58304 
2.58032 
4340.60 
4346.82 


LONGBASE 
57 0533482 
-858672 


416.36 


LONGBASE 
53294.50 
- 1069035 


452.52 


GOAL 


57054.15 
-8587 7236 


400.00 


GOAL 


53293 
- 10707. 34 


400.00 


APPENDIX I: FORMULATION OF THE PROBLEM AS A NONLINEAR PROGRAM 
AND ALGORITHM CHOICE 


Using the objective function defined in Ch. III, the 
mathematical formulation for the array locational correction 


problem is stated as follows: 


INDICES: 
i coordinate index 
j triple overlap region index, j=1,...,NR, 
k sensor array index 


GIVEN DATA: 


"p: (teal postelons( x,y, 2), fOr array k for 1=1,2,3 

ДЕР initial orientation (xtilt,ytilt,zrot) for array 
k for i=1,2,3 

NR, number of triple overlap regions for array k 

У(2) the DVP of the water as a function of depth 


E . the transit times of the acoustic pings 
VARIABLES: 

Decision: 

ОИ = Lecatclon shift (x,y.,z,xtilt,ytilt,zrot) for 
array k for i=1,...,6 

Internal: 
ис 5 роп error (z) forlarray k in region j 
{HER} = horizontal range error for array k in region 
{PHER,,} = aZimuth angle error for array k in region 


J 

шаўца варо тое (xX»v 2) from array k in region j 
for 1=1,2,3, this is a function the arrays 
location (decision variables), the DVP and 
transit time, evaluated through the ray 
tracing algorithms 

ОО Е ро-10о< (5. у,2) from array k in region |) 
ion» 5 thrs 165 а Similar function to the 
above, but uses three independent arrays 
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(HL,;) horizontal range from array k to LBL posloc 
in region j 

CS, tea horizontal range from array k to SBL posloc 
in region j 

(РН) = azimuth angle from array k to LBL posloc іп 
region j 

(ЕНЕ = azimuth angle from array k to SBL posloc in 
region j 


CONSTRAINTS: 


Hr = (олг. өт ал ӨГ. 
Boe a= Como р Ғот ат 


f(v(z),t) = this function is used to construct the 
acoustic ray path 


доро з ПРАСКА ДОБ Е) 
for all k,j 1=1 2 
(this function is evaluated using the iterative ray 
tracing algorithms [Ref. 1]) 


А = (ХА, у; АСУ Е) = 
ток ај] к,ј 1=1 2. 
(this function is similar to the above (f,), but uses 
three independent arrays, for region j, in the posloc 
evaluation [Ref. 3]) 


СЕК); = Ху; T XSkj3 Гог а11 К,) 
PHL, | = arctan[ (XL, i27 X45) / (ХІ ;1-Хь 1) ] | 

for all К,) 1-1 20008 
PHS, ; = arctan[ (XS, ;.-X, >) / (XS, 1-X 4) | | , 

for all k,j X12 
PHER | зо ВНІ Ра, for all аи 
X, = ХХ, + ©НТЕТ for all k, 320520 
A, = АХ, + ЗАВ а for all ў. = 
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EDS ке for all k, 1-1,2 


Sus) 1-7 пошта К 


X,; within the RANGE coordinate system for all К, i-1,2,3 


Х 3 > 0 (array must be below water) for all k 


OBJECTIVE FUNCTION: 


MIN Е” ee Е t (HL, PHERI 
k j= 
for all k with NR = 6 

The first summation in the objective function is over the 
set of index k which yields the value NR, =6. This isolates 
the problem to the interior arrays only. 

Due to the nature of underwater ray tracing, the objective 
function and constraints are nonconvex and nonlinear. This 
environmental nature also prevents the analytical expression 
of the functions f, and f, (see the dynamic programming 
solution outlined in Ref 1). Without the analytical 
expressions of these functions the gradients аге also 
unavailable in analytical form. Based on the above, any 
algorithm requiring the evaluation of the gradient would be 
too time consuming requiring the evaluation of the functions 
to obtain the gradients. With this in mind, we choose an 
algorithm that does not require the evaluation of a gradient. 


Among the algorithms available without using a gradient are 


1259 


the cyclic coordinate descent algorithms. These algorithms 
allow the problem structure to be more efficiently exploited. 

A simulated annealing algorithm was used to determine the 
(global) optimality of the solution provided by ERRFIX. This 
algorithm allowed alternate local solutions to the problem to 
be found. Based on computational experiments, solutions from 
simulated annealing were only marginally better than those 
obtained using ERRFIX. Thus it is hypothesized that ERRFIX 
provides a nearly global optimal solution. Letting ERRFIX 
perform more iterations may enhance the quality of the 


solution produced. 
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